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Flexibility effects on robot manipulator design and 
control are typically ignored which is justified when 
large, bulky robotic mechanisms are moved at slow speeds 
However, when increased speed and improved accuracy is 
desired in robot system performance it is necessary to 
consider flexible manipulators. This project simulates 
the motion of a single-link, flexible manipulator using 
the Equivalent Rigid Link System dynamic model and 
experimentally validates the computer simulation results 
Validation of the flexible manipulator dynamic model is 
necessary to ensure confidence of the model for use in 
future design and control applications of flexible 
manipulators . 
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I . 



INTRODUCTION 



The desire to design, build, and operate a lightweight, 
long-reach manipulator for NASA space shuttle usage was a 
prime impetus for generating interest in the flexibility 
effects of robotic arms [Ref. 1: pp. 3, 9]. Interest in 
improving productivity in automated manufacturing plants 
through increased speed and accuracy have additionally 
sparked a desire to further investigate flexibility effects 
in mechanical devices [Ref. 2: pp. 1, 2]. The design, 
construction, and operation of a flexible robotic manipulator 
arm has many attractive features. In the past the manipulator 
was assumed being composed of rigid links and dictated that 
the link design be large members, both in cross-sectional 
area and weight. The flexible arm would require minimal 
material and consequently would have less weight and bulk 
than conventional rigid-arm robots. With a smaller, lighter 
weight manipulator, less power would be needed to move the 
arm which could mean use of smaller actuators . Arm speed 
movement would increase if the actuator size is not reduced. 

A smaller, lighter weight manipulator would require less 
foundation mounting strength and rigidity requirements . The 
reduced foundation mounting requirements coupled to the less 
material required for the arm construction would translate 
to a lower overall cost to build a flexible-arm robot compared 
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to a rigid-arm robot. The reduced mass of the flexible-arm 
robot would cause less damage if inadvertent collision 
occurred and would be consequently safer to operate compared 
to a rigid- arm robot. Finally, the reduced weight of the 
flexible-arm robot would allow for easy transportability 
[Ref. 3 : p . 1209 ] . 

The preceding discussion of the advantages of utilizing 
flexible-arm robots points to their tremendous potential for 
application in industry, in the military, and in space. In 
spite of these advantages for utilizing flexible-arm robots, 
until recently there has been a reluctance to investigate 
the design and control of flexible manipulator arms. One 
reason for this reluctance is the degradation of the end- 
effector positioning accuracy due to the increased deformation 
of the lightweight, flexible arm. Also, the increased vibra- 
tion of the flexible arm causes a significant control problem 
when coupled with the large-scale translational and/or 
rotational motion of the robot [Ref. 3: p. 1209]. This control 
problem arises due to the reduced bandwidth of the flexible 
manipulator system and the consequent limitation on values of 
gain in the control design. The reduced bandwidth is the 
result of the lower fundamental frequency inherent in a 
flexible manipulator system compared to a rigid system. In 
order to benefit from the advantages of lightweight , flexible 
manipulators it is necessary to implement a control design 
capable of achieving end-effector positioning accuracy and 
stable control. 
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Extensive research began in the early 1980's into the 
design and control aspects of a flexible manipulator arm. 
Information on the dynamic response and the natural frequen- 
cies of the flexible manipulator arm is useful to the designer 
in predicting deformations and stress levels. An accurate 
dynamic model including flexibility allows for simulation 
studies by the designer enabling him to extract his required 
information. An accurate dynamic model including flexibility 
is also necessary for any controller design which is to sub- 
sequently control a flexible manipulator [Ref. 2: pp. 2, 3]. 

An integral, essential part of improving the accuracy and 
stability problems associated with flexible manipulator arms 
is, therefore, the development of an accurate, dynamic model 
of the flexible arm. There are several approaches to the 
development of a flexible structure dynamic model in the 
literature, some of which are reviewed below. 

Until recently, the approach to modeling robotic mecha- 
nisms assumed a rigid structure. The motion consequently 
described by these models included only the large, rigid- 
body motion, hereafter referred to as large motion. The 
recent approach in the development of a dynamic model for 
robotic mechanisms is to include the small motion deforma- 
tions arising from the flexibility of the structure, 
hereafter referred to as small motion. These small motion 
deformations include bending, twisting, and axial extending. 
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Sunada and Dubowsky [Ref. 4] utilized the 4x4 transforma- 
tion matrices including the effects of flexibility to describe 
the kinematics of flexible arm motion, specifically applied to 
industrial robots. The small motion deformations were super- 
imposed on an assumed nominal large motion to include the 
effects of flexibility. This model ignored, however, the 
effect of the small motion interaction on the large motion, 
and consequently did not give a complete description of the 
actual motion dynamics . Sunada and Dubowsky utilized finite 
element method techniques and a method to discretize the 
distributed motion known as Component Mode Synthesis to 
obtain linear, ordinary, differential equations of motion. 

Book [Refs. 5, 6] similarly included the small motion 
deformations in the 4x4 transformation matrices but he 
utilized a modal approach to model the flexible kinematics 
and truncated the series of assumed vibration modes. After 
application of Lagrange's equation and utilizing a combined 
set of large and small motion hybrid coordinates, a complica- 
ted set of dynamic equations of motion were obtained. The 
resulting equations of motion were non-linear in both large 
and small motion variables and were consequently time- 
consuming and expensive to solve . 

Cannon and Schmitz [Ref. 7] utilized a similar modal 
approach with a Lagrangian formulation to model a single- 
link flexible arm. This particular model was obviously very 
restrictive in its application to robotic mechanisms . Cannon 
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and Hollars [Ref. 8] are investigating the modeling and 
control of two-link manipulators with flexible tendons, 
but it appears that the resultant dynamic model is likewise 
restrictive to this special application. 

Truckenbrodt [Ref. 9] modeled the flexible manipulator 
as a "hybrid multibody system" consisting of both rigid 
and flexible elements . The application of his model was to 
a specialized example and compatibility between links was 
not clearly shown. 

Huston [Ref. 10] developed the dynamic equations of 
motion for a flexible, multi-link manipulator utilizing 
a combination Newton-Euler approach and d'Alembert's 
principle. His assumption of a nominal large motion on 
which to apply the small motion deformations was similar 
to Dubowsky's and results in an incomplete representation 
of the actual motion dynamics. 

Chang [Ref. 2] introduced an Equivalent Rigid Link 
System (ERLS) to describe the large motion kinematics. 

The small motion deformations were described relative to 
the Equivalent Rigid Link System. Applying finite element 
techniques and Lagrangian dynamics, two sets of coupled, 
non-linear, ordinary differential equations of motion were 
obtained. Because of the use of the ERLS, these sets of 
equations were composed of one set for large motions and one 
set for small motions. The set of large motion equations 
were non-linear in both the large and small motion variables. 
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The set of small motion equations were linear in the small 
motion variable and non-linear in the large motion variable. 
These particular characteristics of the resultant sets of 
equations of motion allowed for their relatively easy solution 
by a technique developed by Chang known as the Sequential 
Integration Method. Chang's model offered a complete repre- 
sentation of the dynamics of flexible manipulators as well 
as one that could be efficiently solved using the Sequential 
Integration Method. 

The purpose of this research is to experimentally validate 
the accuracy of a dynamic model including flexibility. The 
dynamic model chosen is that developed by Chang. This model 
is tailored to a single-link flexible arm that was designed, 
constructed, and operated for the purpose of the dynamic 
model validation. Hydraulic actuation of the single-link 
arm is utilized and the motion of the arm is limited to a 
vertical plane. Computer simulation of the experimental 
flexible arm using the adapted dynamic model is on the IBM 
3033. The integration methods from the Continuous System 
Modeling Program (CSMP) are utilized in the solutions of the 
dynamic equations of motion. Techniques for the acquisition 
of position data of the moving experimental arm are reviewed 
in a subsequent chapter. Photography and strain gauge 
measurement prove to be the most economical and simple 
procedures in this application. 
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The remainder of this thesis includes a chapter on the 
theoretical approach to model the dynamics of the flexible 
manipulator using the Equivalent Rigid Link System (ELRS) . 

The Theoretical Approach chapter also includes a discussion 
on the modelling of the hydraulic actuation dynamics and a 
discussion of the computer simulation of the entire flexible 
manipulator system. 

A chapter is devoted to a description of the experimental 
approach utilized in validating the dynamic simulation results 
The chapter reviews the design of the experimental manipulator 
system, including the hydraulic actuation and the flexible arm 
The Experimental Approach chapter also reviews various tech- 
niques investigated for experimentally determining the end- 
point position of the flexible manipulator. 

The Results chapter follows and presents a comparison of 
the arm-tip position data obtained during the experimentation 
to the arm-tip position data obtained from the computer 
simulation. Also, a comparison is made between the actual 
strain of the experimental arm and the strain predicted by 
the ERLS dynamic model. 

A chapter devoted to the control of flexible manipulators 
is included to provide a brief literature review on this 
aspect of flexible manipulator research. Additionally, an 
initial attempt at controlling the single-link flexible 
manipulator using the ERLS model is discussed. 
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Finally, a chapter each is devoted to drawing conclusions 
on the lessons learned in this research effort and for making 
recommendations on the future direction of research in 
flexible manipulators . 
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II. THEORETICAL APPROACH 



Chang's dynamic model is based on his introduction of an 
Equivalent Rigid Link System (ERLS) to describe the large 
rigid motion of the flexible manipulator system. The small 
motion deformations are described relative to' the ERLS. The 
local coordinate system for each link is defined in the ERLS 
and deformations are measured relative to this coordinate 
system. Coordinate transformation utilizing joint variables 
of the ERLS is applied to the actual deformed position at any 
point on a link to obtain the absolute position of that point 
Time derivatives of the absolute positions are necessary for 
the kinetic energy derivation for use in Lagrange's equations 

It is necessary to discretize the deformations since 
these displacements are for each point along the flexible 
arm. The Finite Element Method (FEM) is utilized to accom- 
plish this discretization of the deformations . The FEM nodal 
displacements represent the small motion deformations at the 
end of the link. A cubic shape function is assumed for each 
beam element. Choice of a cubic shape function ensures the 
complete representation of the displacement including rigid 
body rotation, translation, and compatibility of the displace 
ment between elements . 

After having described the kinematical relationships 
between the large and small motions, kinetics is introduced 
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to complete the derivation of the dynamic equations of 
motion. Utilizing the Lagrangian formulation requires the 
definition of generalized coordinates. The description of 
large and small motions are a logical choice for the 
generalized coordinates. The joint variables of the ERLS 
and the nodal displacements are the two sets of generalized 
coordinates utilized in Lagrange's equations. The kinetic 
energy has contributions from each link, actuators, and any 
loading. The potential energy has contributions from the 
elastic strain energy and from gravity. Generalized forces 
are included due to any applied forces and damping forces . 
After considerable effort in mathematical manipulations, 
rearrangements, and simplifications, the Lagrange equations 
yield two sets of non-linear, coupled, second-order , ordinary 
differential equations . One set of equations describes the 
large motions and the other set of equations describes the 
small motions, though both sets remain coupled. Details of 
the adaptation of Chang's ERLS model to the experimental, 
single-link, flexible arm are contained in Appendix A. 

The equations of motion for the single-link flexible 
arm are written as two sets of equations, one set consisting 
of one equation for the large motion and one set consisting 
of two equations for the small motion as follows, 

MQQ 9 + MQN U = FQ (1) 

MNQ 9 + MNN U + KN U = FN (2) 

where , 
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MQQ is the lxl inertia matrix for large motions, 

MQN is the 1x2 coupled inertia matrix of the small motion 
contribution to the large motion, 

MNQ is the 2x1 coupled inertia matrix of the large motion 
contribution to the small motion, 

MNN is the 2x2 inertia matrix for small motion, 

KN is the 2x2 stiffness matrix, 

FQ is the lxl load vector for the large motion, 

FN is the 2x1 load vector for the small motion, 

9 is the generalized coordinate of the single joint 
variable representing the large motion, 

U is the 2x1 generalized coordinate vector of the 
deformations representing the small motion. 

Utilizing hydraulic actuation for the single-link 
manipulator necessitates the derivation and the inclusion 
of the hydraulic actuator dynamics into the equations of 
motion of the flexible arm. The inclusion of the hydraulic 
power system dynamic equations into the flexible manipulator 
equations of motion involves the transformation of an input 
current to an output torque . The servovalve and actuator 
dynamics are included to make the description complete. Moog 
simplifies their servovalve dynamics to a single non-linear 
equation [Ref. 11], 




where Q is the flow delivered from the servo valve, 
I is the input current, 
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K is the valve sizing constant computed from the flow 
conditions and is the servovalve contribution to the 
overall hydraulic system damping 

is the valve pressure drop and is equal to the 
difference between the supply pressure, P g , and the 
load pressure drop, P^. 

The actuator dynamic includes the following continuity 
equation and the torque output equation [Ref. 12, pp. 133-138] 



V t P 1 

Q = D m 0 + C tm P 1 + TT 



(4) 



T, = n.u Pi d 
d t 1 m 



(5) 



where Q is flow delivered from the servovalve to the 
actuator , 

0 is the flow component causing actuator rotation, 
C tm Pj_ is the leakage flow in the actuator, 



v t p i 

4 15 



is the compressibility flow, 



is the required torque delivered to move the load 
and to overcome intertia, 
n t is the torque efficiency, 

D m is the motor displacement, 

0 is the actuator motor angular velocity, 

P^ is the time derivative of the load pressure drop, P^, 
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C is the total leakage coefficient of the actuator 
tm 

and is the actuator contribution to the overall hydraulic 

system damping 

V is the total compressed volume including actuator 

lines and chambers, 

B is the effective bulk modulus of fluid, 
e 

Values for each of these parameters are computed from 
the actuator specifications and from good engineering 
judgement. 

The following diagram shows the transformation of the 
input current to an output position and includes the hydraulic 
and flexible manipulator dynamics, 



INPUT 

CURRENT 



HYDRAULIC 


- 


FLEXIBLE 


ACTUATION 




MANIPULATOR 


DYNAMICS 




DYNAMICS 



OUTPUT 

POSITION 



The preceding hydraulic dynamic equations and relation- 
ships are incorporated into the main computer program for 
solving the dynamic equations of motion for the experimental 
single-link flexible arm listed in Appendix B. 

Computer simulation of the equations of motion for the 
experimental arm and hydraulic actuator required the solu- 
tion of three simultaneous, non-linear, coupled, second-order, 
ordinary, differential equations. Fortran language and the 
double precision, variable-step, fourth-order, Runge-Kutta 
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integration method available through the Continuous System 
Modeling Program (CSMP) are utilized in coding the simulation. 

Eq. 1 and 2 can be substituted into a matrix format to 
create a 3x3 coefficient inertia matrix and a 3x1 right-hand 
side of forces and moments. The unknowns become the large 
motion joint variable acceleration and the small motion 
deformation vector accelerations. The matrix format appears 
as follows: 



MQQ 


MQN 




0 


= 


FQ 


MNQ 


MNN 




U 


= 


FN - KN U 



Construction of the computer coding involves forming 
each of the elements of the coefficient inertia matrix and 
the force/moment vector in a separate subroutine. Once 
formed the elements are assembled into the matrix after 
which an IMSL linear equation solver subroutine is used to 
solve for the accelerations. The accelerations are integrated 
twice using the double precision, variable-step, fourth-order, 
Runge-Kutta integration method available through the Continu- 
ous System Modeling Program (CSMP) . Finally a transformation 
from local coordinates to global coordinates takes place to 
get global position information on the motion of the arm tip. 
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Initially, the single -link parameters and the motion 
variables initial conditions are input. There is also a need 
to form the various transformation, inertia, and assorted 
other matrices for use later in the inertia and force/moment 
matrix subroutines. Another prerequisite for constructing 
the equations of motion are subroutines for doing matrix 
multiplication and addition, and for doing the matrix opera- 
tions of the transpose and the trace. These subroutines are 
all listed in the copy of the coding in Appendix B. 

Results from the computer simulation and their comparison 
to the actual experimental motion data are discussed in the 
Results chapter. 
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III. EXPERIMENTAL APPROACH 



The experimental validation of the Equivalent Rigid Link 

V 

System (ERLS) dynamic model on a single-link flexible manipu- 
lator required a significant preliminary design effort. The 
power system for the experimental arm needed to be chosen, 
designed, and purchased. Detailed design of the single-link 
flexible arm needed to be completed and the arm needed to be 
manufactured. Techniques for the measurement of the position 
versus time of the flexible arm tip needed to be investigated 
and a suitable technique chosen. The power system and the 
experimental single-link flexible arm finally needed to be 
assembled into an operational system and the arm tip position 
measurement technique needed to be implemented. 

It was decided to choose a hydraulic system to power the 
experimental arm. The reasons for this choice included the 
desire to increase the Mechanical Engineering Departments' 
exposure to hydraulics and to utilize the knowledge gained 
while taking the Fluid Power Control course. The Naval 
Surface Weapons Center, White Oak, located at Silver Spring, 
Maryland agreed to fund the purchase of the required components 
of the hydraulic power system as a result of their support of 
the robotic research effort in the Mechanical Engineering 
Department at the Naval Postgraduate School. 
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The design of the hydraulic power system involved the 
selection of the appropriately sized actuator, servovalve, 
and power unit, as well as the selection of a suitable servo- 
controller, high pressure filter and position transducer. 
Miscellaneous hoses and fittings were obviously also required 
for the final system assembly. 

The power supply selected was a York hydraulic power unit 
that was available in the Mechanical Engineering Department. 
This unit was overhauled and upgraded to include a 3 horse- 
power motor and starter to increase the system supply pressure 
to 2250 psi. 

The selection of the servovalve and actuator required the 
following analysis [Ref. 12: pp. 81, 133-138] 

1. Assume a load description of the form 

j e + t . = t , 

1 d 

where J is the total moment of inertia of the arm 
and the load reflected from the base, 

T^ is the maximum load torque including the weight 
of the arm and maximum loading (15 lbf) in the horizontal 
position, 

T^ is the required torque delivered to move the load 
and to overcome inertia, 

9 is the actuator motor angular acceleration 

• * * O 

2. Assume a design point of 6=45 deg/sec, 6=45 deg/sec 
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3. The given geometry and dimensions of the arm and loading 
results in the following total inertia, 

J = 74.6942 in-lbf-sec^. 

4. The maximum load torque including the weight of the arm 
and the loading is, 

T^ = 804.380 in-lbf. 

5. Assume the system supply pressure, P , is 2000 psi and 

s 

that the load pressure drop, P^, is 2/3 of P g = 1333.3 psi. 
Assume the torque efficiency is worst case, n t = *6. 

The required displacement of the motor, D , is 
therefore , 

T 

D = — = 1.0788 in / rad 

m i^Pj, 

The selected actuator must at least have this displace- 
ment. Bird-Johnson ' s 3-axis Hyd-Ro-Wrist with a displacement 

3 

in the pitch axis of 4.0 in /rad was chosen. The wrist 

3 

additionally has yaw and roll axes each with a 1.0 in /rad 
displacement. However, in this thesis research only the 
pitch axis was utilized and the yaw and roll axes were 
removed . 

6. The selection of the servovalve required an estimation 
of the flow delivered to the actuator at design conditions. 
The continuity equation (Eq. 4) describes the flow to the 
actuator. 
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is assumed zero. After using 



At design conditions 
good engineering judgement in assuming values for each 
parameter, the design flow corrected to rated conditions 
becomes , 

Q-design = .637 gpm 

Moog 760-100 servovalve having a 1.0 gpm rated flow 
was selected. 

7. A Moog servocontroller and a high pressure filter 
assembly were chosen to complete the hydraulic power 
system. A Bourn potentiometer will be used to extract 
large motion rotation data for use with the photography 
measurements in determining arm tip position. 

Ideas for the design of the experimental arm were 
initially investigated by visiting the robotic research 
laboratories at Stanford University and at SRI International. 
The experimental -flexible manipulator systems utilized by 
Cannon at Stanford and by Andeen at SRI provided valuable 
information for the design of the experimental arm [Ref. 7], 
Figures 1, 2 and 3 are photographs of the experimental flexible 
arm and the hydraulic power system. The basic configuration 
of the arm includes two parallel, flexible, steel, flat bars 
connected by thin steel strips to transverse steel bridges. 

The parallel flat bars provide for flexibility in a vertical 
plane only. This flexibility is minimally hindered by the 
transverse bridges because of the thin, connecting, flexible 
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Figure 1. Single-Link Flexible Manipulator System. 
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Figure 2. Manipulator in an Intermediate Vertical Position. 
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Figure 3. Hydraulic Rotary Actuator. 






strips. The transverse bridges increase torsional rigidity 
and reduce the tendency of the arm to twist while in motion. 
Figure 4 is a photograph showing the inclusion of the trans- 
verse bridges in the flexible arm construction. External 
loading is attached to the arm tip end transverse bridge 
by the securing of the load on the four welded studs. The 
hydraulic actuator is attached to the other end of the 
flexible arm. 

The validation of the ERLS dynamic model requires the 
comparison between the predicted arm tip position from the 
model and the actual arm tip position from the experimental 
single-link manipulator. The computer program listed in 
Appendix B generates the flexible arm tip position referenced 
to a planar, global coordinate system having the origin at 
the hydraulic actuator rotation axis. The problem of deter- 
mining the arm tip position of an experimental, flexible 
manipulator is far more difficult than that experienced in 
determining the arm tip position of a rigid manipulator. 

There is currently a significant research effort in developing 
accurate techniques for arm tip position measurement and 
control of a flexible manipulator. A brief summary of the 
techniques investigated for possible use in this thesis 
research follows. 

The first technique considered was the crude but effec- 
tive method of taking motion pictures of the arm against a 
grid background with a time counter in the field of view. 
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Figure 4. Flexible Manipulator Showing 

Transverse Bridges, Tip Loading 
and Grid Background. 
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The arm tip position at any time is manually determined on 
each picture frame by counting the number of grid lines in 
the vertical and horizontal directions. 

Cannon and Schmitz [Ref. 7] utilized an optical sensing 
system of a focusing lens, a photodetector, an amplifier, 
and an A/D converter to acquire position data from their 
horizontally moving, flexible arm. An incandescent light 
bulb was affixed to the tip of the arm and provided the 
light intensity that was received by the optical sensing 
system. This technique appeared to be suitable for its 
specialized application, but may not be as satisfactory in 
general usage. 

The National Bureau of Standards has conducted manipula- 
tor end-point position sensing experiments using an automatic 
laser tracking interferometer system. Initial experiments 
have provided very promising results [Ref. 13]. The signifi- 
cant drawbacks to this laser tracking technique were its 
current high cost and complicated technology. 

Andeen has utilized strain gages and extrapolated the 
deflection to the arm tip assuming first mode vibration. 

This technique was relatively simple, but may be inaccurate 
unless the predominant mode of vibration is the first mode. 

Interfacing the planar motion of the flexible arm to a 
digitizing tablet provided a potentially feasible technique 
for acquiring arm tip position. This technique would allow 
for automatic, time-efficient, position data acquisition. 
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This technique was obviously only applicable to planar 
motion of the manipulator and was expensive to implement 
for large motion excursions of the arm. 

Lt. William M. Dunkin [Ref. 14] conducted research at 
the Naval Postgraduate School on the use of ultrasonics for 
a position reference system of a manipulator arm. His work 
was preliminary in nature and his experiments utilized a 
stationary manipulator. Despite the poor accuracy of the 
results, use of ultrasonics for arm tip positioning and 
control has significant potential if further research 
continues to perfect this technique. 

Use of a position/displacement transducer that provided 
an electrical signal proportional to the linear extension of 
a cable offered another technique for automatic, position 
data acquisition. Arranging a transducer on each planar' 
coordinate axis and affixing each cable to the arm tip would 
allow for accurate positioning to occur. To utilize this 
measuring technique would require the inclusion of the cable 
tension in the arm dynamic equations of motion. 

Use of accelerometers followed by two electrical integra- 
tions to yield position information offers good frequency 
response and are commercially available. Use of a digitizing 
vision system for automatic position data acquisition has 
great promise for future robotic applications, but is 
currently very expensive to implement. [Ref. 15] 
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For this research the use of motion pictures and strain 
gages were selected based on the availability, simplicity, 
and cost. The use of motion pictures in planar applications, 
though tedious, can provide excellent results of arm tip 
position data. Strain gages are utilized to compare the 
actual strain of the experimental arm to the strain predicted 
by the ERLS dynamic model. 
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IV. RESULTS 



The validation of the ERLS dynamic model includes a 
comparison between the actual arm tip position and the 
predicted arm tip position. The actual arm tip position 
measurements were obtained by taking motion pictures of 
the experimental arm and by a frame-by-frame examination 
of the motion. As an additional check/ the utilization 
of strain gages allowed for a comparison between the actual 
strain of the experimental arm and the strain predicted by 
the ERLS dynamic model. 

Evaluation of the plots of experimental and theoretical 
position or strain requires a comparison criteria. Frequency 
and amplitude are the parameters utilized in establishing 
the criteria for comparison. Similarity in frequency content 
and amplitude is necessary for determination of proper 
control action in the closed-loop servo system design and 
for an accurate representation of the actual motion in any 
flexible manipulator machinery design application. A relative 
percentage error of +/-10% from the experimental results is 
considered the standard for comparison. The strain amplitude 
and frequency errors are computed by taking the difference 
between the theoretical and experimental strain values. The 
strain amplitude is a combination of both fundamental and 
second mode amplitudes but examination of the plots reveals 
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that the first mode amplitude is dominant. The strain 
frequency error is separated into the fundamental and 
second mode errors. The tip position amplitude error is 
computed by taking the square root of the sum of the squares 
of the differences between the theoretical and experimental 
X and Y coordinate positions. The tip position frequency 
errors are computed by taking the difference between the 
theoretical and experimental tip position frequencies. Only 
the first mode frequency and amplitude errors are determined 
for the arm tip position. The normalization of the absolute 
error to a relative error is accomplished using the arm 
length for the tip position amplitude measurements and the 
experimental strain amplitude for the strain amplitude 
measurements. The experimental frequencies are used for 
normalizing the tip position and strain frequency errors. 

This normalization is accomplished in order to compute the 
appropriate order of magnitude error between the theoretical 
predictions and the experimental results. 

Figures 6, 7, and 8 are plots for three loading conditions 
of the comparison of experimental to theoretical arm tip 
positions in the global X (horizontal) and Y (vertical) 
coordinate directions. The three loading conditions are the 
no-load condition, the 5 pound load condition, and the 10 
pound load condition. The excitation of the hydraulic 
actuation for all three loading conditions is a step input 
of 4 milliamps current. The initial condition for these 
experimental runs is the horizontal position of the flexible 
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Figure 6. X and Y Tip Position For No Load. 
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Figure 7. X and Y Tip Position For 2.115 Kg Load. 
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Figure 8. X and Y Tip Position for 4.23 Kg Load. 
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arm. Experimental arm tip position data requires a prelimi- 
nary parallax correction and a geometric transformation 
prior to plotting. The parallax correction is necessary 
because of the relatively close proximity of the camera to 
the experimental arm motion. The geometric transformation is 
necessary because of the offset of the base of the experi- 
mental arm from the axis of rotation of the hydraulic actuator. 

Four CEA-06-12UW-350 strain gages are installed on the 
flexible arm. Two are placed on opposite sides of the 
neutral axis at the base and at the mid-longitudinal 
position of the arm. Consequently, two gages provide 
tensile strain readings and two gages provide compressive 
strain readings. A mid-longitudinal position gage is 
selected for plotting strain data because of the higher 
sensitivity, and consequently better resolution, in the 
strip chart recording. The theoretical strain predicted 
by the ERLS dynamic model in the mid-longitudinal position 
is computed from the Finite Element shape matrix describing 
the transverse or bending displacement of the flexible arm. 

The derivation of the theoretical strain is included in 
Appendix C. Figures 9, 10 and 11 are plots for the three 
loading conditions of the comparison of experimental to 
theoretical microstrain. Excitation of the hydraulic 
actuation for all three loading conditions is a step input 
of 4 milliamps current. The initial condition for these 
experimental runs is the vertical position of the flexible 
arm. 
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Figure 9. Microstrain For No Load. 
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Figure 11. Microstrain For 4.23 Kg Load. 



Utilization of the evaluation criteria of +/-10% error 
reveals the tip position amplitude error is acceptable. This 
is significant considering the importance of tip position 
accuracy as a criteria for evaluating robot performance. 
Because of the lack of adequate tip position accuracy for 
certain applications a significant research effort is ongoing 
to develop appropriate tip sensors to compensate for the 
position errors. The acceptable tip position amplitude 
error despite the single element modelling allows for 
relatively accurate predictions of tip position motion and 
consequently suggests the potential usefulness of the ERLS 
model in improving the tip position accuracy. Table I lists 
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the relative percentage errors of tip position amplitude 
for the different loading conditions given a 4.0 milliamp 
input current to the servovalve. 



TABLE I 

RELATIVE PERCENTAGE ERRORS OF TIP POSITION AMPLITUDE 



No Load 


10.7 


2.11 Kg Load 


10.5 


4.23 Kg Load 


11.5 



The differences in amplitude observed in the arm tip 
position measurements are attributed to the error in 
recording the experimental position data, to the single 
element modelling of the experimental arm, and to the small 
displacement assumption of the vibration. Specifically, the 
frame-by-frame examination of the arm tip position is 
hindered by the lack of clarity of the arm tip and by the 
absence of definition of the background grid measurement 
lines. Improvement in the grid spacing and color intensity 
and in the camera exposure setting would improve the quality 
of the recorded data. The increased rigidity resulting from 
the single element model of the experimental arm is responsi- 
ble for the amplitude of the theoretical X tip and Y tip 
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position data to be less than the experimental position data 
and would increase as the number of elements is increased 
in the model. 

Axial deformations are neglected and small bending 
displacements are assumed in the theoretical modelling of 
the experimental arm. The effect of these assumptions is 
noticed in the comparison of the X coordinate arm-tip posi- 
tion during the first few tenths of a second of motion. 

The experimental arm tip position actually decreases during 
this initial time period. The theoretical model predicts 
an increase in arm tip position, particularly during the 
heavier loading conditions. Figure 12 illustrates how the 
theoretical model could predict an increase in the X coordi- 
nate tip position. The theoretical arm position approximates 
the actual arm position and because the small motion displace- 
ment is measured with respect to the ERLS local coordinate 
axis the theoretical arm length appears to increase. This 
arm length increase is especially amplified with large 
displacements which result from heavier loading. For smaller 
displacements the arm length increase is negligible. The 
increase in the arm length is reflected by an increase in 
the theoretical X coordinate tip position. 

The motion pictures were taken at a camera speed of 24 
frames per second. Since the fundamental and second mode 

frequencies of the experimental arm without any load are 2 

* 

hertz and 13 hertz respectively, only the fundamental 
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Figure 12 

- - - ERLS and Theoretical Arm Position 

Experimental Arm Position 

EXP Experimental X-Coordinate 

AL Actual Experimental Arm Length 

THE Theoretical X-Coordinate 

v Theoretical Arm Tip Displacement 
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frequency is observed by the motion pictures. Comparison of 
the frequency content of the experimental and theoretical 
arm tip position reveals close agreement for the fundamental 
frequency. Comparison of the frequency content of the experi- 
mental and theoretical strain reveals that the experimental 
results have lower frequency content compared to the theoreti- 
cal results in both the fundamental and second mode frequencies. 
Utilization of the evaluation criteria reveals the standard of 
+/— 10% relative percentage error is exceeded for the second 
mode frequency using the strain measurements. Table II lists 
the relative percentage errors of the frequencies for the 
different loading conditions given a 4.0 milliamp input 
current to the servovalve. 



TABLE II 

RELATIVE PERCENTAGE ERROR OF FREQUENCIES 



Strain Data Fundamental Second Mode 



No Load 


5 


38 


2.115 Kg Load 


5 


26 


4.23 Kg Load 


6 


22 



Tip Position Data Fundamental 



No Load 


< 5 


2.115 Kg Load 


< 5 


4.3 Kg Load 


< 5 
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The no-load theoretical fundamental and second mode 



frequencies are predicted to be 2 hertz and 18 hertz 
respectively. The difference in frequency content between 
the theoretical predictions and the experimental results is 
explained in that only one element from the Finite Element 
Method is utilized in modelling the experimental arm. The 
single element model limits the number of degrees of freedom, 
and consequently the flexibility, of the dynamic model. The 
dynamic model therefore appears more rigid than the actual 
experimental arm. Increasing the number of elements in 
modelling the experimental am would increase the flexibility 
of the dynamic model which would reduce the frequencies of 
predicted motion. Error between the experimental and theoreti- 
cal results is additionally introduced by the limited resolu- 
tion of the strain measurements from the strip chart recorder. 

Utilization of the evaluation criteria reveals the 
standard of +/-10% error is exceeded for strain amplitude 
measurements. Table III lists the relative percentage errors 
of strain amplitude for the different loading conditions 
given a 4.0 milliamp input current to the servovalve. The 
amplitude of the theoretical strain measurements are typically 
less than the experimental strain measurements in both the 
fundamental and second mode frequencies. This observation is 
again explained by the limitation on flexibility imposed by 
the single element model of the experimental arm. Increasing 
the number of elements in modelling the experimental arm would 
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increase the flexibility of the dynamic model which would 
result in increased amplitudes of predicted strain. 



TABLE III 

RELATIVE PERCENTAGE ERRORS OF STRAIN AMPLITUDE 



Strain Data 



No Load 


38 


2.115 Kg Load 


38 


4.23 Kg Load 
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Table II indicates that the relative percentage error of 
the first mode frequency increases slightly while the error 
of the second mode frequency decreases as the loading is 
applied. Tables I and III indicates that the relative 
percentage error of the tip position and strain amplitudes 
increases slightly as the loading is applied. As mentioned 
before, the first mode amplitude is dominant. With increased 
loading the experimental arm becomes softer or more flexible. 

The dominant first mode strain amplitude and the first mode 
tip position amplitude are slightly more difficult to predict 
as the arm flexibility increases. This observation is con- 
sistent with the slight increase in error in the first mode 
frequency as the loading increases. These trends are consistent 
with the previous observations that the theoretical predictions 
result in a stiffer system compared to the experimental results. 
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In other words, the single element model better predicts the 
first mode amplitude and frequency of a stiff system compared 
to a softer system. As the loading increases resulting in 
a more flexible system, the first mode strain frequency and 
dominant first mode strain amplitude errors increase slightly. 
Similarly, the first mode tip position amplitude error 
increases slightly. 

The trend of the strain second mode frequency error 
initially appears as an anomaly since the error decreases as 
the loading increases. This trend contradicts the expected 
result that is observed in the first mode frequency and 
amplitude error trends. The trend in the second mode 
frequency error suggests that the theoretical model more 
easily predicts the second mode frequency of a softer system. 
In other words, the theoretical model is better suited for 
predicting the second mode frequency in a flexible system. 

The accuracy of the theoretical model to predict the 
experimental arm deformation is dependent upon the shape 
function approximation of the natural modes. The choice 
of the shape function described in Appendix C to describe 
the deformations results in the observed trend in the strain 
second mode frequency error with loading. 

Investigation of the predicted and actual strains for 
an excitation of 3.0 milliamps current to the servovalve was 
made and revealed similar trends in frequency and amplitude 
errors as noted in the 4.0 milliamps case. As expected, the 
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maximum strains achieved and predicted are less in the 3.0 
milliamps case. However, the relative error percentages in 
the 3.0 milliamps case are not any less than the 4.0 milliamps 
case. This suggests that the small displacement assumption 
has little effect on increasing the strain amplitude and 
frequency errors as the strain is increased. However, this 
suggestion is obviously limited to this particular experiment 
and needs to be investigated for other values of excitation 
current. 

The assumptions of single element modelling, of small 
displacement theory, and of no axial deformation are made 
for analytical expediency and for computational efficiency. 

The validity for making these assumptions should be reviewed 
in light of these experimental results. 

The importance of correct modelling of the hydraulic 
dynamics was emphasized when the interaction of the hydraulic 
actuation, the gravitational force, and the arm movement from 
the vertical plane created a serious resonance problem. This 
phenomenom was observed during the theoretical strain simula- 
tions and resulted in serious instability after approximately 
one second of motion. Investigation revealed that the hydrau- 
lic damping was improperly modeled. The resonance was 
eliminated after a modification to the damping was made. 
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V. CONTROL OF FLEXIBLE MANIPULATORS 



The advantages to employing flexible manipulators is 
well documented in the literature [Ref. 16: pp. 101, 102]. 
However, flexible manipulator usage in industry has been 
minimal principally as a result of the difficulty to control 
the flexible manipulator end-effector [Ref. 3: p. 1209] 

There has been considerable research recently in the 
development of flexible manipulator control strategies 
using state-space model techniques. A brief survey of this 
research follows. 

Cannon and Schmitz [Ref. 1] introduced the concept of 
end-point position feedback for use in controlling flexible 
manipulators. The end-effector position was sensed and was 
fed back to the controller for subsequent determination of 
the control action required by the joint actuators. Use of 
end-point position feedback would increase the response speed 
and would allow for the use of lightweight flexible manipula- 
tors. Techniques for determining the position of the 
manipulator end-point were reviewed in the Experimental 
Approach chapter. 

Cannon and Schmitz [Ref. 7] utilized a modal approach 
with a Lagrangian formulation to model a single-link flexible 
arm. Both large motion rotation and small motion deformations 
of the flexible arm were included in a single variable in the 
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formulation. The state-space model resulted in a set of 
decoupled differential equations where the states included 
the rigid body mode and the flexible modes. Cannon and 
Schmitz limited the state- space model to include only the 
first three flexible modes. The flexible mode states 
included contributions from large motion rotation as well 
as small motion deformations. The joint actuator provided 
direct control action to the large motion rotation of the 
arm. Since the flexible mode states included coupling 
between the large and small motions, the joint actuator 
provided control action to the small motion deformations as 
well. This ensured state controllability of the state space 
model. Output controllability was ensured after determination 
of the arm-tip sensor and the joint-rate sensor measurement 
vectors’ in the state-space output equation. The joint angle 
and rate were measured with a potentiometer and a tachometer, 
respectively. Since all flexible mode states were not 
measurable. Cannon and Schmitz included an estimator in the 
feedback control system to ensure that the system was observa- 
ble. The Linear Quadratic Gaussian (LQG) approach was 
utilized in the controller design. Experimental verification 
of the feedback control system on a single-link flexible 
manipulator demonstrated that stable and precise position 
control of the end-effector was achieveable. 

Book and Hastings [Ref. 5] similarly utilized a Linear 
Quadratic Regulator approach in designing a controller for a 
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flexible manipulator. Their state-space model consisted of 
a rigid body mode state and the first two flexible modes as 
subsequent states. Their initial formulation of the dynamic 
equations of motion included coupling between the rigid 
body mode and the flexible modes, and ensured state control- 
lability. Output controllability was ensured after determina- 
tion of the strain gauge sensor, joint-position sensor, and 
joint-rate sensor measurement vectors in the state-space 
output equation. The modal deflections were measured from 
strain gauge data. Observability was ensured by including 
an estimator in the feedback control system to estimate the 
two unmeasured modal velocities. Minimizing the first two 
open-loop modal resonances in an experimental single-link 
flexible manipulator confirmed the feedback control system's 
ability to control the flexible modes. One significant 
difference between the Book and Hastings model and the Cannon 
and Schmitz model was that the former utilized flexible modes 
corresponding to fixed-free beam vibrations whereas the latter 
utilized pinned-free beam vibrations. The fixed-free flexible 
mode model allows for a more accurate extension to the multi- 
link manipulator since fixed link boundary conditions describe 
the multi-link physical system. 

Adaptation of Chang's Equivalent Rigid Link System flexible 
model [Ref. 2] to the single-link manipulator provided another 
alternative to the modal approach in defining state variables. 
Defining both large motion rotations and small motion deforma- 
tions as generalized coordinates in the Lagrangian formulation 

I 
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of the dynamic equations provided an easy extension for 
these coordinates to become state variables. A comparison 
of the state-space model to the ERLS non-linear model was 
needed to determine the range of the applicability of the 
linearized model away from the operating point. Comparison 
of simulations of open loop large motion rotation, theta, 
and small motion deformations indicated reasonable agreement 
between the state-space model and the ERLS non-linear model 
for approximately 1.5 sec. or 120 degrees after an input 
torque of 5 N-m was applied. 

The state space representation provided the input to 
the NPS mainframe optimal feedback controls program CONTROLS, 
subprogram OPTSYS, to design an LQR optimal controller. 
Coupling between the large and small motions included in 
the Lagrangian dynamic equation formulation ensured state 
controllability. After assigning arbitrary identity matrices 
for the output measurement matrix and the weighting matrices 
for the quadratic performance index, an optimal feedback 
gain control matrix was computed by the OPTSYS program. 
Details of the linearization and state-space representation 
of the ERLS model and the optimal feedback control design 
are included in Appendix D. The definition of the output 
measurement matrix assumed the feedback loop was closed 
utilizing tip control. Simulation of the state-space model 
closed-loop response to an initial condition of a 20 degree 
rotation away from the zero degree operating point, a -.08 
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meter tip deflection and a -.1 tip slope confirmed the 
linear feedback control systems' ability to control the 
state-space model of the single-link flexible arm. A graph 
of the linear system closed-loop response of the large motion 
rotation, theta, is plotted in Figure 13. This result gives 
some confidence in the linear controller's ability to control 
the non-linear model given small perturbations about the 
operating point. However, simulation of the linear controller 
with the non-linear model is necessary to investigate the 
range of operation. 

Utilizing the arm-tip deflection and slope as state 
variables appears to be an improvement over the flexible 
mode state variables since the former are more easily 
measurable quantities. The need for an estimator in .the 
feedback control system may be eliminated. However, addi- 
tional comparison and investigation of the merits of both 
approaches are necessary. From the results obtained from 
other research it appears that control of a single- link 
flexible manipulator is realizable. Extension of these 
feedback control system approaches to multi-link flexible 
manipulators is necessary if the advantages of flexible 
manipulators is to be realized in practical industrial 
applications . 
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Figure 13. Closed-Loop Response. 



VI. CONCLUSIONS 



The purpose of this research is to experimentally 
validate the ERLS dynamic model. The validation of the 
ERLS dynamic model is needed to ensure confidence of the 
model for use in future design and control applications. 

In this research, the ERLS model is tailored to a single- 
link flexible arm having hydraulic actuation and moving in 
a vertical plane. The vertical plane motion introduces 
the effects of gravity. The investigation of the effects 
of gravity on flexible manipulator movement allows for the 
consideration of applications not limited to space usage. 

The investigation of hydraulic power actuation allows for 
the consideration of heavy load applications. The effects 
and interactions of modelling the flexible arm with gravity 
and the hydraulic actuation revealed the importance of 
proper determination of parameters, specifically those 
affecting damping. 

The acceptable tip position amplitude error despite the 
single element modelling suggests the ERLS model's potential 
usefulness in improving the tip position accuracy. This 
potential benefit is significant considering the importance 
of tip position accuracy as a criteria for evaluating robot 
performance. 
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The results of the validation indicated the theoretical 



strain and position measurements are affected by the under- 
lying assumptions of the ERLS model. Specifically, the FEM 
single element modelling of the experimental arm results in 
a more rigid description of the actual motion and gives 
smaller amplitudes and higher frequencies. The results 
indicate that as loading is applied to the single element 
model the relative percentage errors of the first mode 
amplitude and frequency increase slightly. As loading is 
applied, the experimental arm becomes more flexible and the 
single element model's performance in predicting the first 
mode motion degrades. The results indicate though that the 
single element model is better suited for predicting the 
second mode frequency as the loading is increased. The 
relative percentage errors for frequency indicate, however, 
that the single element model better predicts the first mode 
motion compared to the second mode motion. 

The small displacement assumption results in additional 
error to the theoretical strain and position predictions. 

This error is most noticeable during the initial stages of 
the X coordinate tip position motion and increases as the 
loading increases. The small displacement assumption does 
not appear to have much effect though, on the strain amplitude 
and frequency errors as evidenced by the lack of any error 
increase as the strain is increased by a larger hydraulic 
excitation current. This conclusion needs to be investigated 
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for other excitation current values. Other assumptions 
are made on the values of certain mechanical and hydraulic 
parameters, particularly inertia properties of the arm and 
actuator. These assumed values undoubtedly contribute to 
the error in the theoretical predictions. The agreements 
and differences between the simulation and the experiment 
in both arm-tip position and strain measurements provide a 
valuable validation of the ERLS model. The experimental 
data serves as a guideline to upgrade the dynamic model, 
particularly in the validity of the underlying assumptions. 
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VII. RECOMMENDATIONS 



A principal goal in this research is to eventually use 
the ERLS dynamic model in the design of a complete flexible 
manipulator system. This system would include a multi-link 
flexible manipulator and a servo control loop. Two areas of 
research needed to achieve this goal are, therefore, the 
control system design and the optimal design of a flexible 
manipulator. 

Continued simulation studies of a closed-loop system 
having the controller design based on the ERLS model are 
needed. Alternative control laws need to be investigated 
for possible use in this application. Concurrent work is 
needed on the continued validation of the ERLS dynamic model. 
Specifically, the single element FEM modelling of deformations 
should be extended to a multi-element model. Validation of 
the arm and actuator inertia properties needs to be accom- 
plished. The intent of the continued validation of the ERLS 
dynamic model is to bring the theoretical arm motion into 
closer agreement to the experimental arm motion. This 
refinement of the dynamic model is useful for an effective 
controller design based on the model. Additional techniques 
for the acquisition of arm tip position need to be investiga- 
ted and implemented. Specifically, sensors for arm tip 
position need to be implemented in order to feedback position 
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data to the controller for appropriate control action. 
Alternatives for arm tip position sensors include accelero- 
meters and optics. The controller design eventually needs 
to be implemented in hardware and/or software and tested. 
Extension of the controller design and implementation to 
the multi-link case is eventually needed if the advantages 
of flexible manipulators is to be realized in practical 
industrial applications. 

Once experimental validation is completed the ERLS 
dynamic model will allow computer simulation for designing 
a mechanical manipulator with a desired rigidity. Further 
investigation is needed into the optimal design of a flexible 
manipulator. 
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APPENDIX A 



DERIVATION OF THE EQUATIONS OF MOTION FOR THE 
EXPERIMENTAL, SINGLE -LINK, FLEXIBLE ARM 

Given the large and small motions as generalized coordi- 
nates, the following are the two sets of Lagrange equations 
used to develop the equations of motion: 

d/dtOKE/3 0) - 3KE/30 + 3PE/30 = F (A.l) 

d/dtOKE/au) - 3KE/3U + 3PE/3U = 0 (A. 2) 

KE - kinetic energy 

PE - potential energy 

0 - large motion joint variable, theta 

U - 2x1 vector of small motion displacement and slope, v 
and $ 

F - generalized force for large motion, applied moment 

The actual motion of the experimental arm is restricted 
to lie in a vertical plane. The hydraulic actuator is 
attached -to the base of the arm. The load is attached to the 
end of the arm. The large motion joint variable theta is the 
angle measured between the ERLS link and the global coordi- 
nate system horizontal axis. 

• The origin of the global coordinate system is the axis 
of the hydraulic actuator, the base joint. 

The horizontal and vertical axes of the global coordinate 
system are parallel and perpendicular to the earth. The ERLS 
link is parallel to the tangent of the experimental arm at the 
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base joint. Figure A.l shows the relationships between the 
ERLS and the theoretical arm position. The vector of small 
motion is limited to include only the transverse displacement, 
v, and the slope, <J> , of the end of the arm. Axial deformation 
and torsion are neglected in the model and are considered 
insignificant in this application. The design of the experi- 
mental arm to include two parallel flat bars jointed by a 
series of transverse bridges makes the arm rigid in torsion. 
Figure A.l shows the two components of the vector of small 
motion. 




Figure A.l 
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The kinetic energy of the system includes contributions 
from the arm, the loading and the hydraulic actuator rotor. 
The expressions utilized for the determination of the kinetic 
energy of the system are as follows: 



KE-arm = 1/2 



y R T ( R) dv 



ARM 

VOLUME 



(A. 3) 



KE-load = 1/2 Tr 




(R x )dv 



LOAD VOLUME 



KE-rotor = 1/2 Tr 




(R r )dv 



ROTOR 

VOLUME 



(A. 4) 



(A. 5) 



Tr is the trace operation. 

The global position vector of the arm is determined from 
the following transformation: 

R = -W (r + D) (A. 6) 

W - the 3x3 transformation matrix and is solely a 
function of theta 

r - the 3x1 local position vector of the arm measured 
from the coordinate system whose origin is at the end of 
the ERLS link. Figure A.l shows the positive directions 
for the local coordinate system. 
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D - the 3x1 deformation vector that only includes the 
transverse displacement, v. In order to introduce the nodal 
displacements at the arm tip as the sole deformation variables 
substitution of the shape function matrix and a nodal dis- 
placement vector is made for D. The derivation of this 
substitution is shown in Appendix C. 

y - the mass density of the arm, steel 

The global position vector of the load is determined from 
the following transformation: 



R 1 = W D ± r 1 (A. 7) 

- the 3x3 transformation matrix due to the local 
deformations of the arm tip 

r^ - the 3x1 local position vector for the load 
y^ - the mass density of the load, steel 

The global position vector of the hydraulic actuator 
rotor is determined from the following transformation: 



R = A r (A. 8) 

r r r 

A^ - the 3x3 transformation matrix due to the large 
motion rotation of the rotor 



r r - the 3x1 local position vector for the rotor 
y^ - the mass density of the actuator rotor, aluminum 



The following definitions for the inertia terms are 
utilized to simplify the computations and the resultant 
expressions in the equations of motion: 
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dv - the 3x3 inertia matrix of the load 




LOAD (A. 9) 

VOLUME 




ROTOR 

VOLUME 



the 3x3 inertia matrix of the 
actuator rotor (A. 10) 



1122 (W 



W ) = 
r 



y <J>- 



w w 



<}>^ dv 



LINK 

VOLUME 



(A. 11) 



1122 (W T ,W) = | y <J> 1 T W T W <^ 1 dv (A. 12) 

LINK 

VOLUME 



I121(W T , W q )= | y 4> 1 W T W Q r dv (A. 13) 

LINK 

VOLUME 



I111(W 0 T / W 0 ) 



T T 

y r W 0 W 0 r dv 



(A. 14) 



LINK 

VOLUME 



1112 (W 0 T , W) 



y r T W Q T W <|> dv 



(A. 15) 



LINK 

VOLUME 



I122(W q T , W) 



y <J>^ T W 0 T W dv 



(A. 16) 



LINK 

VOLUME 
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1122 (W Q , W 0 ) = 



y ^ I* 1 * W 0 T W 0 <P 1 dv 



LINK 

VOLUME 



I 



yy 



I 

XX 



y-L y 2 dv 

LOAD 

VOLUME 

r 2 ^ 

]j^ x dv 

LOAD 

VOLUME 



(A. 17) 



(A. 18) 



(A. 19) 



Computation of the preceding link inertia matrices require 
utilization of the 3x2 link shape matrix cf)^, the 3x1 link 
local position vector r, and various combinations of the 3x3 
transformation matrix W. The expression W 0 implies a deriva- 
tive with respect to the large motion joint variable, theta. 

The expression W results from a simplification of the second 
time derivative of the transformation matrix W and is termed a 
residual acceleration. Further details on the derivation of 
these expressions can be found in Reference 2 and a listing of 
these matrices is found in Appendix B in the computer coding. 

The potential energy of the system includes contributions 
from the strain energy of the arm due to deformation and from 
the gravitational energy of the load and the arm. The 
expressions utilized for the determination of the potential 
energy of the system are as follows: 



PE d 



1/2 



E I 

LINK 

LENGTH 



zz 



(V") 2 



dx - potential energy due to 
deformation (A. 20) 
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PE 



g 



T 

y r g dv - potential energy of the link 
J due to gravitation (A. 21) 

LINK 
VOLUME 



PE 



ig 



T 

^1 r l 9 dv - potential energy of the load 
J due to gravitation (A. 22) 

LOAD 
VOLUME 



El - the flexural rigidity in the z direction, or 
z z 

perpendicular to the plane of motion. 

v' ' - the second derivative of the transverse 

displacement v with respect to the x local coordinate 
direction. In order to introduce the nodal displacements 
at the arm tip as deformation variables substitution of the 
second derivative of the shape function matrix with respect 
to the x coordinate direction and a nodal displacement 
vector is made for v''. The derivation of this substitution 
is shown in Appendix C. 

g - the gravitational acceleration vector 



The following definitions are utilized to simplify the 
computations and the resultant expressions in the equations 
of motion: 



K 



11 



r T C T dx 

LINK 

LENGTH 



the 2x2 stiffness matrix 



(A. 23) 



H 



11 



T 

y r dv - 



LINK 

VOLUME 



the link first moment of inertia 
vector (A. 24) 



H 




T 



dv - the link shape matrix first 

moment of inertia vector (A. 25) 



21 



LINK 

VOLUME 



H 



41 



T 

pi i r i dv - the load first moment of inertia 

vector (A. 



(A. 26) 



LOAD 

VOLUME 



T - the second derivative of the shape function matrix. 
C - the 3x3 flexural rigidity matrix including only 



Substitution of the expressions for kinetic energy and 
potential energy into the Lagrange equations and after much 
computation and simplification results in the following two 
non-linear, coupled, second-order, ordinary, differential 
equations for the large and small motions of the single-link 
flexible arm: 

MQQ 0 + MQN U = FQ (A. 27) 

MNQ 0 + MNN U + KN U = FN (A. 28) 

The following are definitions for the coefficients: 



MQN = 1112 (W C T , W) + ((M 1 L + M^ , (M x L + I xx + I yy ) ) 

(A. 30) 



E I 



zz 



MQQ = I111(W 0 T , W Q ) + U T I122(W 6 T , W q ) U + Trace(W g 




(A. 29) 
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L is the link length. M is the first moment of the load 

X 

with respect to the local coordinate y axis. is the mass 

of the load. 

FQ = 2. U T 1122 (W Q T , W) U + H.^ W 0 T g + U T H 21 W Q T g - 
Trace (W^ ^ W r + 2. ^ b* W + A r0 I r A rr ) + 

H 41 °1 T W 0 T g + T (A. 31) 



T is the externally applied torque. A results from a 
simplification of the second time derivative of the transfor- 
mation matrix A^ and is termed a residual acceleration. U 
is the 2x1 nodal displacement vector containing the link tip 
deflection, v(0) , and slope, <j>(0). The expression A^ 0 * 
implies a derivative with respect to the large motion joint 
variable, theta. 



MNQ = (Trace (W^ I ± W T ) , Trace (W 0 D x I D 12 T W T ) ) 

+ I 1 2 1 ( W T , W Q ) (A. 32) 



Du anc ^ ^12 are derivatives of the arm tip 

deformation transformation matrix with respect to each nodal 
displacement, deflection and slope, respectively. 



MNN = 1122 (W T ,W) + 



1 

o 

1 




1 

o 
: > 

1 


0 I + I 




<f> (0) 


xx yy 







(A. 33) 
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v(0) and 4> ( 0 ) are arm tip deflection and slope 
accelerations respectively. 

KN = K 11 + 1122 < wT ' W r ) (A. 34) 

FN = H 21 W T g - (Trace (W^. D ± I 1 D 1;l T W T + 2 . W D ± I 1 
W T ), Trace (W D x ^ D 12 T W T + 2 . W D x I 1 D 12 T W T ) ) 

+ (H 41 D 1x T W T g, H 41 D 12 T W T g) (A. 35) 

The numerical values utilized for the experimental 
flexible arm system variables are listed in Appendix B and 
are in SI units. 



70 



APPENDIX 3 



LISTING OF THE FORTRAN CODING UTILIZED IN SOLVING 
THE DYNAMIC EQUATIONS OF MOTION FOR THE EXPERIMENTAL 

SINGLE-LINK FLEXIBLE ARM 



* SIMULATION OF SINGLE LINK FLEXIBLE MANIPULATOR DYNAMICS 

X 

A 

A 

A THIS PROGRAM SOLVES THE ERLS FLEXIBLE MANIPULATOR DYNAMICS FOR A 
X SINGLE LINK EXPERIMENTAL ARM. THE EXPERIMENTAL ARM PARAMETERS ARE 

A INPUTTED AND THE HYDRAULIC ACTUATION DYNAMICS ARE INCLUDED IN THE 

A SIMULATION. THE INPUT IS THE CURRENT TO THE SERVOVALVE MOUNTED ON 

* THE HYDRAULIC ACTUATOR AND THE OUTPUT IS THE POSITION OF THE ARM 

A TIP IN THE GLOBAL REFERENCE SYSTEM. THE CODING CONSISTS OF A MAIN 

* PROGRAM AND FIFTEEN SUBROUTINES AND ARE DESCRIBED BELOW. 

A 

A THE FOLLOWING PARAMETERS ARE DEFINED: 

A 1 .A-EFFECTIVE CROSS-SECTIONAL AREA OF FLEXIBLE ARM 

A 2 . ARRDD-3X3 SECOND TIME DERIVATIVE OF ROTOR RESIDUAL ACCELERATION 

A MATRIX 

A 3 . ARTH-3X3 ROTOR TRANSFORMATION MATRIX DIFFERENTIATED WITH RESPECT 

A TO THETA 

* A . BE-EFFECTIVE BULK MODULUS OF FLUID 

A 5 . BIGF-3X1 RIGHT-HAND SIDE VECTOR FOR LARGE AND SMALL MOTION 
A ACCELERATIONS 

A 6 . BIGM-3X3 MATRIX OF LARGE AND SMALL MOTION ACCELERATION 
A COEFFICIENTS 

A 7 . CTM-TOTAL LEAKAGE COEFFICIENT OF THE ACTUATOR 

* 8 . DEFM-DISPLACEMENT DEFORMATION VARIABLE 

A 9 . DEFMD-TIME DERIVATIVE OF DISPLACEMENT DEFORMATION VARIABLE 

A 10. DIFF, QERR, QERR1, FACTOR-DUMMY VARIABLES 

A 11 . DL1-3X3 DEFORMATION MATRIX 

A 12 . DL 11-3X3 DEFORMATION MATRIX DIFFERENTIATED WITH RESPECT TO THE 
A DISPLACEMENT DEFORMATION VARIABLE 

A 13 . DL12-3X3 DEFORMATION MATRIX DIFFERENTIATED WITH RESPECT TO THE 
A SLOPE DEFORMATION VARIABLE 

X 14 . DL1D-3X3 FIRST TIME DERIVATIVE OF DEFORMATION MATRIX 

* 15 . DM-ACTUATOR DISPLACEMENT 

X 16. E-MODULUS OF ELASTICITY OF STEEL 

A 17 . FN-2X1 RIGHT-HAND SIDE VECTOR FOR SMALL MOTION ACCELERATIONS 

* 18 . FQ-RIGHT-HAND SIDE FOR LARGE MOTION ACCELERATIONS 

* 19.G-3X1 GRAVITATIONAL ACCELERATION VECTOR 

* 20 . GP0S-3X1 GLOBAL POSITION VECTOR FOR ARM TIP 

* 21 . H11-1X3 LINK FIRST MOMENT OF INERTIA VECTOR 

X 22 . H21-2X3 LINK SHAPE MATRIX FIRST MOMENT OF INERTIAVECTOR 

* 23 . H41-1X3 LOAD FIRST MOMENT OF INERTIA VECTOR 

A 24 . KCE-TOTAL FLOW PRESSURE COEFFICIENT 

A 25 . PL-LOAD HYDRAULIC PRESSURE DROP 

X 26 .PS-HYDRAULIC SUPPLY PRESSURE 

X 27 . QL-FLOW DELIVERED FROM THE SERVOVALVE 

X 28 .SLOP-SLOPE DEFORMATION VARIABLE 

X 29 .SLOPD-TIME DERIVATIVE OF SLOPE DEFORMATION VARIABLE 
X 30.SOL-3X1 VECTOR OF LARGE AND SMALL MOTION ACCELERATIONS 
X 31 . TE-TORQUE EFFICIENCY 

* 32 . TH-LARGE MOTION POSITION VARIABLE 

* 33 . THD-TIME DERIVATIVE OF LARGE MOTION VARIABLE 

X 34 .TORQUE-APPLIED TORQUE BY ACTUATOR 

* 35.U-2X1 ARM TIP DEFORMATION VECTOR INCLUDING DISPLACEMENT AND SLOPE 

* 36.UD-2X1 ARM TIP DEFORMATION VECTOR DIFFERENTIATED WITH RESPECT TO 

* TIME 

* 37 . VT-TOTAL COMPRESSED VOLUME INCLUDING ACTUATOR LINES AND CHAMBERS 

* 33.W-3X3 LINK TRANSFORMATION MATRIX 

A 39.WD-3X3 FIRST TIME DERIVATIVE OF LINK TRANSFORMATION MATRIX 

X 40.WRDD-3X3 SECOND TIME DERIVATIVE OF LINK RESIDUAL ACCELERATION 
X MATRIX 

x 41 . WTH-3X3 TRANSFORMATION MATRIX DIFFERENTIATED WITH RESPECT TO 
X THETA 
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W ^ Vx# ^ W W w w w w 

/T\ /IK ^ i^S mS ^ 



X VALVE 

X 42 . XI IMP-CURRENT INPUT EQUAL TO INITIAL AND FRACTIONAL AMOUNTS 

X 43.XIL-3X3 INERTIA MATRIX OF THE LOAD 
X 44.XI0-INITIAL INPUT CURRENT TO SERVOVALVE 
X 45 . XIR-3X3 ROTOR INERTIA MATRIX 

X 46 .XISTEP-STEP INPUT OF FRACTIONAL AMOUNT OF INPUT CURRENT 
X 47 . XK1 1-2X2 PARTIAL LINK STIFFNESS MATRIX 
X 48.XKN-2X2 LINK STIFFNESS MATRIX 

X 49 . XKV-SERVOVALVE SIZING CONSTANT 

X 50 . XLL-LENGTH OF FLEXIBLE ARM 
X 51. XML-MASS OF LOAD 

X 52.XMNN-2X2 COEFFICIENT MATRIX OF SMALL MOTION ACCELERATIONS IN THE 

X SMALL MOTION DYNAMIC EQUATIONS 

X 53 . XMNQ-2X1 COEFFICIENT VECTOR OF LARGE MOTION ACCELERATIONS IN THE 
X SMALL MOTION DYNAMIC EQUATIONS 

X 54.XMQN-1X2 COEFFICIENT VECTOR OF SMALL MOTION ACCELERATIONS IN THE 
X LARGE MOTION DYNAMICS EQUATION 

X 55 . XMQQ -CO EFFICIENT OF LARGE MOTION ACCELERATION IN THE LARGE MOTION 

X DYNAMICS EQUATION 

X 56 . XMQQP-2X2 DUMMY MATRIX FOR USE IN FORMULATING THE EQUATIONS OF 
X MOTION 

X 57 . XMR-MASS OF ACTUATOR ROTOR 
X 58 . XMU-MASS DENSITY OF STEEL FLEXIBLE ARM 

X 59 . XMX-FIRST MOMENT OF LOAD WITH RESPECT TO THE LOCAL COORDINATE 
X Y. A X I S 

X 60.XXI-VARIABLE REPRESENTING INERTIA-LIKE LOAD PROPERTY 

X 61 . YYI-VARIABLE REPRESENTING INERTIA-LIKE LOAD PROPERTY 

x 62 . ZI-AREA MOMENT OF INERTIA OF FLEXIBLE ARM 
X 

x 

X 

X 

INITIAL 

x 

X INITIAL VALUES OF PARAMETERS ARE INPUTTED VIA XINIT SUBROUTINE 

x 

x 

/ REALX8 UC2, 1) , XMQQC 1 ) , XMQQPC 2, 2) , DL1 C 3 , 3) , WTHC 3, 3 ) , ARTHC 3, 3) , 

/ #XIR(3,3),XMQN(1,2),UD(2, 1 ) , Hll ( 1 , 3) , G( 3, 1 ) , H21 ( 2, 3) , 

/ #WRDDC3,3),DL1D(3,3),WD(3,3),ARRDD(3,3),H41(1,3),XK11(2,2), 

/ »DL12(3,3),XMNQ(2,1),N(3,3),XMNN(2,2),XKN(2,2),FN(2,1),BIGM(3,3), 

/ #BIGF(3,1),XIL(3,3),DL11(3,3),DEFMD(1),S0L(3),THD(1),SL0P(1), 

/ #SL0PD(1),A(1),E(1),ZI(1),XXI(1),YYI(1),FQ(1),GP0S(3),XITH(1), 

/ #XMU ( 1 ) , XLL ( 1 ) , XML C 1 ) , XMRC 1 ) , XMXC 1 ) , TH( 1 ) , TORQUEC 1 ) , DEFM( 1 ) , 

/ #PS ( 1 ) , XI FRACC 1 ) , XI 0 ( 1 ) , KCEC 1 ) , VT C 1 ) , BEC 1 ) , DMC 1 ) , XKV Cl), TEC 1 ) , 

/ #QL Cl), PL (1),DIFF(1),XIINP(1),QERR1(1),QERR(1), FACTORC 1),XISTEP(1) 

FIXED I 
NOSORT 

SYSTEM DPINTG 

4TH ORDER RUNGE-KUTTA DOUBLE-PRECISION INTEGRATION 
METHOD RKSDP 

INITIALIZATION SUBROUTINE 

CALL XINIT(TH,THD,DEFM,DEFMD,SLOP,SLOPD,VO,POSO,A,XML,XMU, . . . 
XLL,XMR,E,ZI,PS,XIFRAC,XIO,CIM,VT,BE,DM,XKV,TE,QL, . . . 

PL,PLIC) 



DYNAMIC 

* 

X COEFFICIENTS FOR BOTH LARGE AND SMALL MOTION ACCELERATIONS 

X AND THE RIGHT-HAND SIDES ARE COMPUTED IN THE FOLLOWING 

X SUBROUTINES. ALSO, THE HYDRAULIC DYNAMICS ARE INCLUDED 

X IN THE MAIN PROGRAM. 

X 

NOSORT 

X 
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X X X X X X X HOKXX X >K X X XXX XXXX XXX XXX XXXX XXXX XXX XX 



HYDRAULIC DYNAMICS 

XISTEP(1)=XIFRAC(1) *STEP( 0.0) 

XIINP(1)=XI0(1 )+XISTEP( 1 ) 

IF(PL(1) .GT.PS(l)) GO TO 2 
GO TO 3 
PL ( 1 ) =PS( 1 ) 

QERR1(1)=(XIINP(1) *XKV (1)*DSQRT(PS(1)-PL(1)))-(DM(1)*THD(1)) 

QERR( 1 )=QERR1 ( 1 )/KCE( 1 ) 

DI FF( 1 ) =QERR( 1 ) -PL ( 1 ) 

FACTORC 1)=VT(1 )/(<+. ODO*BE(1)*KCE(1)) 

DI FF1 (1)=DIFF(1) 

SORT 

PL1=INTGRL(PLIC,DIFF1,1) 

N0S0RT 

PL(1)=PL1(1 )/ FACTOR ( 1 ) 

TORQUE(l)=TE(l)*PLa)*DM(l) 

MATRIX AND VECTOR FORMULATION SUBROUTINE 

CALL F0RM(H,HTH,HD,DL1,DL1D,XIL,XIR,ARTH,WRDD,ARRDD,U,UD, . . . 
XMQQP,G,H11,H21,DL11,DL12,H41,XK11,A,XMU,XML,XLL,TH,THD, . . . 
DEFM,DEFMD,SLOP,SLOPD,E,ZI,XMR,XMX,YYI,XXI) 

COEFFICIENT OF LARGE MOTION ACCELERATION IN LARGE MOTION DYNAMICS 
EQUATION SUBROUTINE 

CALL XLMMQQ(XMQQ,U,XMQQP,DL1,WTH,ARTH,XIL,XIR,A,XMU,TH, DEFM, SLOP) 

COEFFICIENTS OF SMALL MOTION ACCELERATIONS IN LARGE MOTION DYNAMICS 
EQUATION SUBROUTINE 

CALL XLMMQN(XMQN,A,XMU,XML,XLL,XMX,SLOP,DEFM,YYI,XXI) 

RIGHT-HAND SIDE FOR LARGE MOTION DYNAMICS EQUATION SUBROUTINE 

CALL XLMFQ(FQ,U,XMQQP,DL1,HTH,ARTH,XIL,XIR,UD,H11,G,H21,HRDD, . . . 
DL1D, WD, ARRDD, H41 , TH,THD, DEFM, DEFMD-, SLOP , SLOPD, A , XMU, XML , XLL , . . . 
TORQUE) 

LINK STIFFNESS MATRIX SUBROUTINE 

CALL SMKN(XKN,XK11,XMQQP,A,XMU,THD) 

* 

COEFFICIENTS OF LARGE MOTION ACCELERATION IN SMALL MOTION 
DYNAMICS EQUATIONS SUBROUTINE 

CALL SMMNQ(XMNQ,DL1,HTH,XIL,DL11,DL12,H,TH,DEFM,SL0P,A,XMU) 

RIGHT-HAND SIDE OF SMALL MOTION DYNAMICS EQUATIONS SUBROUTINE 

CALL SMFN(FN,H21,H,G,WRDD,DL1,XIL,DL11,DL12,HD,DL1D,H41,TH, . . . 

THD, DEFM, DEFMD, SLOP, SLOPD) 

COEFFICIENTS OF SMALL MOTION ACCELERATIONS IN SMALL MOTION DYNAMICS 
EQUATIONS SUBROUTINE 

CALL SMMNNC XMNN , XMQQP , XML , A , XMU > XXI , YYI , XMX) 

ACCELERATION COEFFICIENTS MATRIX AND RIGHT-HAND SIDE VECTOR 
FORMULATION SUBROUTINE 

CALL BIGFOR(BIGM, BIGF, XMQQ , XMQN, FQ , XMNQ , XMNN , XKN , FN, U) 

LINEAR EQUATION SOLVER FOR ACCELERATIONS SUBROUTINE 
CALL XLEQCBIGM, BIGF, SOL) 

TRANSFORMATION FROM LOCAL COORDINATE TO GLOBAL COORDINATE TIP 
POSITION SUBROUTINE 

CALL GLOB(GPOS,H, DEFM) 
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ooooocom *:*>*<:* * * * 



CALL GL0B(GP0S,W,DEFM) 



INTEGRATE ACCELERATIONS AND THEN VELOCITY TO GET LARGE MOTION 
ANGULAR POSITION AND SMALL MOTION, LOCAL COORDINATE, TIP POSITION 
DO 5 1=1,3 
SOL 1 ( I ) =SOL ( I ) 

5 CONTINUE 
SORT 

VEL=INTGRLCV0,S0L1,3) 

NOSORT 

THD( 1 ) =VEL ( 1 ) 

DEFMDC 1 ) =VEL (2) 

SLOPDC 1 ) =VEL ( 3 ) 

DO 10 1=1,3 
VEL 1 ( I ) =VEL ( I ) 

10 CONTINUE 
SORT 

P0S=INTGRL(P0S0,VEL1,3) 

NOSORT 

TH( 1 ) =POS( 1 ) 

DEFMC 1 ) =POS( 2) 

SLOP ( 1 ) = POS ( 3 ) 

AC1 =ZZRND( SOLI ( 1 ) ) 

AC2 = ZZRND( SOL 1 (2) ) 

AC3 = ZZRNDC SOLI C 3) ) 

VE1=ZZRND(VEL(1) ) 

VE2=ZZRND( VEL (2) ) 

VE3=ZZRND( VEL C 3 ) ) 

P01=ZZRND( POSC 1 ) ) 

P02=ZZRND(P0S(2) ) 

P03=ZZRND( POS C 3 ) ) 

XP0S=ZZRND(GP0S(2)) 

YPOS = ZZRND( GPOSC 3) ) 

TORK=ZZRND( TORQUE ( 1 ) ) 

LPD=ZZRND( PL C 1 ) ) 

OUTPUT GLOBAL COORDINATE TIP POSITION 



TERMINAL 
OUTPUT XPOS 
OUTPUT YPOS 
OUTPUT TIME, XPOS 
PAGE XYPLOT 

LABEL X-POSITI ON CL0AD=.4233 KG ,I=1.02MA) 

OUTPUT TIME, YPOS 
PAGE XYPLOT 

LABEL Y-POSITION (L0AD=.4233 KG ,I=1.02MA) 

TIMER FINTIM *1.5 , OUTDEL = 0.01 , DELMIN = 5.0E-8 



LISTING OF SUBROUTINES 



SUBROUTINE XINIT(TH, THD, DEFM, DEFMD, SLOP, SLOPD, VO , POSO , A, ML , MU, LL , 
#MR , E, ZI , PS , I FRAC , 10 , CTM, VT,BE,DM,KV,TE,QL,PL,PLIC) 

REAL*8 V0(3),P0S0C3),ML,MU,LL,MR,TH, THD, DEFM, DEFMD, SLOP, SLOPD, 
#A,E,ZI,ITORQ,PS,I FRAC ,10, CTM, VT,BE,DM,KV,TE,QL,PL,PLIC,IMAX, 
ITORQ= 27 . 89303003D+00 
DM=6 . 2271D-05 
TE= . 9D+00 
PL=ITORQ/CDMXTE) 

PL IC=PL 

CTM=3 .7064772D-13 

QL=CTM*PL 

KV=2. A02963D-09 

PS=1 . 37888D+07 

1 0 = QL/ ( KVxDSQRT C PS-PL ) ) 

IMAX = 10 .-D+0 0 
I FRAC = .5D+00XCIMAX-I0) 
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ooo 



BE=690 . D6 

A=6 . 17795D-04 

ML = . 42330000000000 

MU =7 86 1 . 05000000000000 

LL=0. 99850000000000 

MR=9 . 00011451000000 

E=2. 0D11 

ZI=4 . 065D-10 

V0(ll=0. 000000000000000 

V0(2)=0. 000000000000000 

V0(31=0. 000000000000000 

POSO( 11=0.00000000000000 

POS0( 21=-. 07804116400000 

P0S0( 3)=-. 09875534300000 

TH = P0S0( 1 ) 

THD=V0( 1 1 
DEFM=P0S0(2) 

DEFMD=V0( 2) 

SL0P=P0S0( 3) 

SL 0PD = V0 C 3 ) 

RETURN 

END 



SUBROUTINE F0RM( W, WTH, WD, DL1 , DL ID, XI L , XIR, ARTH, WRDD, ARRDD , U , UD, 
#XMQQP,G,H11,H21,DL11,DL12,H41,XK11,A,MU,ML,LL,TH,THD, DEFM, DEFMD, 
#SL0P,SL0PD,E,ZI,MR,MX,YYI,XXI1 
REALX8 W(3,31,WTH(3,31,WD(3,31,DL1(3,31,DL1D(3,31 ,XIL(3,31 
REALMS XIR(3,31,ARTH(3,31,WRDD(3,31 ,ARRDD(3,31 ,U(2, 11,UD(2, 11 
REALX8 XMQQP(2,21,G(3,11,H11(1,31,H21(2,31,DL11(3,31,DL12(3,31 
REA L *8 H41 ( 1 , 3 ) , XK1 1 ( 2 , 2 ) , MU , ML , L L , MR , MX , TH 
REALX8 THD, DEFM, DEFMD, SLOP, SLOPD, XXI, YYI, A, E,ZI 
Wd, 11 = 1.00000000000000 
Wd, 21=0. 00000000000000 
Wd, 31 = 0. 00000000000000 
W(2, 11=LL*DC0S(TH1 
W( 2, 21 =DC0S(TH 1 
W(2,31=-DSIN(TH1 
W(3, 11=LL*DSIN(TH1 
W( 3 , 21 =DSIN( TH1 
W( 3 , 3 1 = DC0SC TH 1 
WTHd, 11=0 .00000000000000 
WTHd, 2 1 = 0. 00 00 00 00 0000 0 0 
WTHd, 31 = 0. 00000000000000 
WTH(2,11=-LL*DSIN(TH1 
WTH(2,21=-DSIN(TH1 
WTH( 2 , 3 1 =-DC0S C TH1 
WTH(3,11=LL*DC0S(TH1 
WTH( 3 , 21 =DC0S ( TH 1 
WTH( 3 , 3 l.= -DSINC TH 1 
WD (1,11=0 . 00000000000000 
WDd, 21 = 0. 00000000000000 
WD(1,31=0 .00000000000000 
WDC2, 11=-LL*DSIN(TH1*THD 
WD(2, 21=-DSIN(TH1*THD 
HD(2,31=-DC0S(TH1*THD 
WD( 3 , 1 1 = L LXDCOS (TH 1XTHD 
WD(3,21=DC0S(TH1*THD 
WD(3,31=-DSIN(TH1*THD 
DL 1(1, 11=1. 00000000000000 
DL 1(1, 21=0. 00000000 00 0000 
DL 1(1, 31 =0.00000000000000 
DL 1(2, 11=0 .00000000000000 
DL 1(2, 21 =1.00000000 000000 
DL 1 ( 2 , 3 1 =-SL OP 
DL1(3, 1 1=DEFM 
DL1(3,21=SL0P 
DL 1(3, 31 =1.00000000000000 
DL1D(1, 11=0. 00000000000000 
DL1D(1, 21=0. 00000000000000 
DLlDd, 31 =0.00000000000000 
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DL1DCZ, 1)=0 . 00000000000000 

DL1DC2,2)=0. 0000000000000 

DL1DC2,3)=-SL0PD 

DL1DC3, 1)=DEFMD 

DL1D( 3, 2) =SL0PD 

DL 1D( 3, 3)=0. 00000000000000 

XI L C 1 , 1 ) =ML, 

XILC1,2)=0. 00 067141 300000 
XI L( 1,3)=. 00000000000000 
XI L(2,l)=0. 00 0671418 00000 
XILC2,2)=1 .422D-06 
XI L(2,3)=0. 00000000000000 
XI L(3,l)=. 00000000000000 
XI L(3,2)=0. 00000000000000 
XIL(3,3)=5. 97754 D- 04 
MX=. 00067141800000 
XXI=1 .422D-06 
YYI=5.97754D-04 
XIR( 1 , 1 ) =MR 

XI R(l,2)=0. 00 0000000000000 
XIR(1,3)=0. 000000000000000 
XI R(2,l) =0.000000000000000 
XI R( 2,2)=. 027467130000000 
XIR(2,3)=0. 000000000000000 
XI R( 3, 1)=0. 000000000000000 
XI R(3,2)=0. 00 0000000000000 
XIR(3, 3) =.02746713000000 
ARTHC 1 , 1 ) =0 .00000000000000 
ARTHC 1,2)=0. 00000000000000 
ARTH( 1, 3 )=0 .00000000000000 
ARTH(2, 1 )=0 .00000000000000 
ARTHC2,2)=-DSINCTH) 
ARTH(2,3)=-DC0S(TH) 

ARTH( 3, 1 )=0 .00000000000000 

ARTH(3,2)=DC0S(TH) 

ARTH(3,3)=-DSIN(TH) 

HRDDC 1, 1)=0 .00000000000000 
WRDDC 1 , 2 ) =0 .00000000000000 
HRDDC 1 , 3 ) =0 .00000000000000 
HRDDC2,1)=-LL*DC0SCTH)*CTHDXX2) 
WRDD(2,2)=-DC0S(TH)*(THD*X2) 
WRDDC 2, 3)=DSIN(TH)XCTHDXX2) 
WRDDC 3, 1 ) = -LLxDSINC TH)XC THDXX2 ) 
WRDD(3,2)=-DSIN(T,H)*(THD*X2) 

WRDDC 3,3)=-DC0SCTH)XCTHDX*2) 
ARRDDC 1 , 1 ) =0 . 00000000000000 
ARRDDC 1 , 2) =0 .00000000000000 
ARRDDC 1, 3 )=0 .00000000000000 
ARRDDC 2, 1)=0 .00000000000000 
ARRDDC2,2)=-DC0SCTH)*CTHD**2) 
ARRDDC 2, 3)=DSINCTH)XCTHDX*2) 
ARRDDC 3, 1)=0 .00000000000000 
ARRDDC3,2)=-DSIHCTH)XCTHDX*2) 
ARRDDC 3, 3) = -DC0SCTH)XCTHD*x2) 

UC 1, 1) = DEFM 
UC 2, 1 ) =SL0P 
UDC 1 , 1 ) =DEFMD 
UDC 2,1) =SL0PD 

XMQQPC 1,1) =.37 14286 0000000 
XMQQPC 1 ,2)=-. 05238100000000 
XMQQPC 2, 1)=-. 05238100000000 
XMQQP C 2, 2) =. 00952380000000 
GC1,1)=0. 00000000000000 
GC2,1) =0.00000000000000 
GC3,l)=-9. 806 60000000000 
HI 1 C 1 , 1) =4. 856 519 00 000 000 
HI 1C 1,2) = -2.4282586 9 30 00 00 
HI 1 C 1,3) =0.00000000000000 
H21C1, 1)=0 . 00000000000000 
H21 Cl, 2) =0 .00000000000000 
H21 C 1 , 3) =A*MU*C .50000000000000) 
H21C2, 1)=0 . 00000000000000 
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H21 (2, 2)=0. 00000000000000 
H21( 2, 3 )=A*MU*(-. 08333333333333) 
DO 50 1=1,3 
DO 60 J=1 , 3 

DL 11(1, J)=0. 00000000000000 
DL12(I, J)=0 .00000000000000 
60 CONTINUE 
50 CONTINUE 

DL1 1 ( 3 , 1 ) =1 . 00000000000000 
DL12(2,3)=-1 .00000000000000 
DL1 2(3, 2) =1 .00000000000000 
H41 (1,1) =ML 

H41 (1, 2 )=0. 000671418000000 
H41( 1,3)=. 000000000000000000 
XK1H1, 1) = 12. U0 000000000000XEXZI 
XKll(l,2)=-6. 000000000000XEXZI 
XKll(2,l)=-6 .000000000000XEXZI 
XK11(2,2)=4. 00 0 00 00 00 000 OX ExZI 
RETURN 
END 



SUBROUTINE XLMMQQ (MQQ , U, XMQQP, DL 1 , WTH , ARTH , XI L , XIR , A, MU, TH , DEFM , 
#SLOP ) 

REALX8 MQQ,UT(1,2),P(1,2),DL1T(3,3), WTHT (3,3), ARTHT (3,3),P1(3,3) 
REALX8 P2(3,3),P3(3,3),P4(3,3),P5(3,3),P6(3,3),P7(3,3),MU 
REALX8 U(2,1),XMQQP(2,2),DL1(3,3), WTH( 3, 3 ) , ARTH( 3, 3),XIL(3,3) 
REALX8 XIR( 3, 3) , A , TH, DEFM, SLOP, SP, TP 
M=2 
L = 1 
N = 3 

MQQ = 0 . 00000000000000 
CALL TRANS( U , UT, M, L ) 

CALL MATMUL(UT, XMQQP, L,M,M,P) 

CALL MATMUL ( P,U,L,M,L,SP) 

CALL TRANS(DL1,DL1T,N,N) 

CALL TRANS(ARTH, ARTHT, N,N) 

CALL TRANS( WTH, WTHT , N, N ) 

CALL MATMUL (WTH, DL1,N,N,N,P!>) 

CALL MATMUL (P1,XIL,N,N,N,P2) 

CALL MATMUL (P2,DL1T,N,N,N,P3) 

CALL MATMUL ( P3 , WTHT , N, N , N, P4 ) 

CALL MATMUL (ARTH, XIR, N, N, N, P5) 

CALL MATMUL (P5 , ARTHT , N, N, N, P6 ) 

CALL MATADD( P4,P6,N,N,P7) 

CALL TRACE( P7 , N, TP ) 

MQQ=((1./3.)XAXMU) + (AXMUXSP) + TP 

RETURN 

END 



SUBROUTINE XLMMQN( XMQN , A , MU , ML , LL , MX, SLOP, DEFM, YYI , XXI ) 

REAL*8 XMQN( 1,2) , MU , ML , LL , MX, A, SLOP , DEFM, YYI , XXI 

XMQN(1,1)=(AXMUX( .35000000000000) )+(ML*LL)+MX 

XMQN( 1, 2) =(AXMUX(-. 05000000000000) )+(MXXLL)+YYI+XXI 

RETURN 

END 



SUBROUTINE XLMFQ( FQ, U , XMQQP , DL1 , WTH, ARTH, XIL , XIR, UD, HI 1 , G, H21 , 
#WRDD, DL1D,WD,ARRDD,H41,TH, THD, DEFM, DEFMD, SLOP, SLOPD,A,MU,ML,LL, 
#TORQUE) 

REALX8 FQP(2,2),P(1,2),P1(1,3),P2(1,3),P3(1,3),P4(3,3),P5(3,3) 
REALX8 P6(3,3),P7(3,3),P8(3»3),P9(3,3),P10(3,3),P11(1,3),P12(1,3) 
REALX8 FPFH( 3 , 3 ) , FHP ( 3, 3 ) , FPT( 3 , 3) , DL1DT ( 3 , 3) , WDT( 3 , 3 ) , ARRDDT ( 3 , 3 ) 
REALX8 UT(1,2),DL1T(3,3),WRDDT(3,3),FPF(3,3),FPS(3,3), WTHT (3,3) 
REALX8 U( 2 , 1 ) , XMQQP ( 2,2),DL1(3,3), WTH( 3,3), ARTH( 3,3),XIL(3,3) 
REALX8 XIR(3,3),UD(2,1),H11(1,3),G(3,1),H21(2,3),WRDD(3,3) 

REALX8 DL1D(3,3),WD(3,3),ARRDD(3,3),H41(1,3),MU,LL,ML 
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REAL*8 A, TORQUE, FQ, TH , THD, DEFM, DEFMD, SLOP , SL OPD 
REAL*8 FP, SP , TP , TFP , FTHP 
M=2 
L = 1 
N = 3 

CALL TRANS ( U , UT , M, L ) 

DO 10 1=1,2 
DO 20' J = 1 , 2 

FQP( I , J ) =XMQQP( I , J )*THD 
20 CONTINUE 
10 CONTINUE 

CALL MATMUL (UT,FQP,L,M,M,P) 

CALL MATMUL ( P , UD , L , M, L , FP ) 

CALL TRANS(WTH,HTHT,N,N) 

CALL MATMUL ( Hll , WTHT , L , N, N , PI ) 

CALL MATMUL (P1,G,L,N,L,SP) 

CALL MATMUL (UT,H21,L,M,N,P2) 

CALL MATMUL C P 2 , WTHT , L , N , N , P3 ) 

CALL MATMUL (P3,G,L,N,L,TP) 

CALL TRANS ( DL 1 , DL IT , N , N ) 

CALL TRANSCWRDD, WRDDT,N,N) 

CALL MATMUL ( WTH , DL 1 > N , N, N , PA ) 

CALL MATMUL ( PA, XI L , N , N , H , P5 ) 

CALL MATMUL (P5,DL1T,N,N,N,P6) 

CALL MATMUL C P 6 , WRDDT , N, N, N> FPF) 

CALL TRANS ( DL ID, DL IDT, N, N) 

CALL TRANS(WD,WDT,N,N) 

CALL MATMUL (HTH,DL1,N,N,N,P7) 

CALL MATMUL (P7,XIL,N,N,N,P8) 

CALL MATMUL (P8,DL1DT,N,N,N,P9) 

CALL MATMUL ( P9 , WDT , N , N , N , FPS ) 

CALL TRANSCARRDD, ARRDDT , N, N) 

CALL MATMUL (ARTH, XI R, N, N, N, P10 ) 

CALL MATMUL ( PI 0, ARRDDT, N,N,N,FPT) 

DO 30 1=1,3 
DO AO J=l, 3 
FPS ( I , J ) =FPS( I , J ) 5(2 . 

AO CONTINUE 
30 CONTINUE 

CALL MATADD( FPF^FPS , N, H, FPFH) 

CALL MATADD( FPFH, FPT , N, N, FHP ) 

CALL TRACE( FHP, N, TFP ) 

CALL MATMUL (HA1,DL IT, L,N,N,P11) 

CALL MATMUL (Pll, WTHT, L,N,N,P12) 

CALL MATMUL ( PI 2, G, L,N, L, FTHP) 

FQ=(-2.*AXMU*FP) + SP + TP - TFP + FTHP + TORQUE 

RETURN 

END 



SUBROUTINE SMKNC XKN , XK11 , XMQQP , A , MU , THD) 

REAL 3(8 XKN ( 2, 2) > KNPC 2, 2) , XMQQP ( 2,2),XK11C2,2) , A, THD, MU 
DO 10 1=1,2 
DO 20 J=1 , 2 

KNPC I, J)=XMQQP(I, J)XC-A)*MU*CTHDXX2) 

XKNC I , J ) =KNP( I , J )+XKll ( I , J ) 

20 CONTINUE 
10 CONTINUE 
RETURN 
END 



SUBROUTINE SMMNQCXMNQ, DL 1 , WTH, XIL , DL 11 , DL 12 , N, TH , DEFM, SL OP , A , MU) 
REAL*8 XMNQC2, 1 ) , DL 12TC 3, 3 ) , DL 1 1TC 3 , 3 ) , WTC 3 , 3 ) ,P1(3,3) ,P2(3,3) 
REAL*8 P3C3,3),PAC3,3),P5C3,3),P6C3,3),DL1C3,3),WTHC3,3),XILC3,3) 
REAL^8 W(3,3),DL11(3,3) , DL 1 2( 3 , 3 ) , TH, DEFM, SLOP , A , MU 
M=2 
L = 1 
N = 3 

CALL TRANS ( DL 11 , DL 11T, N, N) 
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CALL TRANSCDL12, DL12T,N,N) 

CALL TRANS(W,WT,N,N) 

CALL MATMUL (WTH,DL1,N,N,N, PI) 

CALL MATMUL ( PI > XI L , N , N , N , P2 ) 

CALL MATMUL ( P2,DL1 IT, N,N,N,P3) 

CALL MATMUL (P 3, WT , N, N, N,P4) 

CALL TRACE(P4,N,TFP1) 

XMNQC 1,1) =TFP1 + ( ( .35000000000000)*AXMU) 
CALL MATMUL ( P2, DL 12T , N, N , N , P5) 

CALL MATMUL (P5,WT,N,N,N,P6) 

CALL TRACE(P6,N,TFP2) 

XMNQC2, 1)=TFP2 + ( - . 05000000000000*A*MU) 

RETURN 

END 



SUBROUTINE SMFNC FN , H21 , W, 6, WRDD, DL1 , XI L , DL1 1 , DL 12 , WD, DL1D,H41,TH, 
#THD, DEFM,DEFMD,SLOP, SLOPD) 

REAL*8 FNC2, 1 ) , PI ( 2 , 3) , P2C 3 , 3) , P3C 3, 3 ) , P4C 3, 3) , P5 ( 3, 3) , P6 ( 3, 3) 
REALX8 P7(3,3),P8(3,3),P9(3,3),P10(3,3),P11(3,3),P12(3,3),P13C3,3) 
REAL*8 P14(1,3),P15(1,3),P16(1,3),P17(1,3),TP(2,1),FP(2,1),SP(2,1) 
REALX8 FN1(3,3),FN2(3,3),G(3,1),H21(2,3),WRDD(3,3),DL1D(3,3) 

REALX8 WD(3,3),H41(1,3),XIL(3,3),W(3,3), DL11(3,3),DL12(3,3) 

REALX8 DL1(3,3),DL11T(3,3),DL12T(3,3),WT(3,3) 

REALX8 TH,THD, DEFM, DEFMD, SLOP, SLOPD 
M=2 
L = 1 
N = 3 

CALL TRANS ( W , WT, N , N ) 

CALL MATMUL CH21 , WT,M,N,N,P1) 

CALL MATMUL CP1,G,M,N,L,FP) 

CALL TRANS ( DL11 , DL11T, N, N) 

CALL TRANS.C DL12, DL12T, N, N) 

CALL MATMUL C WRDD, DL1,N,N,N,P2) 

CALL MATMUL ( P2 , XI L , N, N , N, P3) 

CALL MATMUL (P3,DL11T,N,N,N,P4) 

CALL MATMUL (P4,WT,N,N,N,P5) 

CALL MATMUL (WD, DL1 D, N, N, N, P6 ) 

CALL MATMUL CP6,XIL,N,N,N,P7) 

CALL MATMUL C P7 , DL 1 IT , N, N , N, P8 ) 

CALL MATMUL CP8,WT,N,N,N,P9) 

CALL MATMUL C P3 , DL 12T , N , N, N , PI 0 ) 

CALL MATMUL ( PI 0 , WT, N, N , N, PI 1 ) 

CALL MATMUL ( P7 , DL 12T, N, N, N , P12) 

CALL MATMUL (P12,WT,N,N,N,P13) 

DO 10 1=1,3 
DO 20 J=1 , 3 
P9C I , J )= P9(I,J)*2. 

P13CI, J)=P13(I, J)*2. 

20 CONTINUE 

10 CONTINUE ‘ 

CALL MATADDCP5, P9,N,N,FN1) 

CALL MATADDC PI 1 , P13 , N, N, FN2) 

CALL TRAC EC FN1 , N,TFN1 ) 

CALL TRAC EC FN2,N,TFN2) 

SPC 1 , 1) =TFN1 
SP ( 2 , 1 ) =TFN2 

CALL MATMUL ( HA1, DL 1 IT, L,N,N,P14) 

CALL MATMUL (P14,WT,L,N,N,P15) 

CALL MATMUL (P15,G,L,N,L,FN3) 

CALL MATMUL (H41,DL12T,L,N,N,P16) 

CALL MATMUL ( P16 , WT , L , N, N, P17 ) 

CALL MATMUL (P17,G,L,N,L,FN4) 

TPC 1 , 1 ) =FN3 
TP ( 2 , 1 ) = FNA 
DO 31 1=1,2 

FNC 1 , 1 ) = FP( 1 , 1 ) - SP(I,1) + TPC 1 , 1 ) 

31 CONTINUE 
RETURN 
END 
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SUBROUTINE SMMNN( XMNN , XMQQP , ML , A , MU , XXI , YYI , MX ) 
REALX8 XMNN(2,2),XMQQP(2,2),ML,MU,A,XXI,YYI,MX 
DO 10 1=1,2 
DO 20 J=1 , 2 

XMNNd, J)=0 .00000000000000- 
20 CONTINUE 
0 CONTINUE 

XMNN(1, 1)=ML 
XMNN (1,2) =MX 
XMNNC 2 , 1 )=MX 
XMNNd, 2)=XXI+YYI 
DO 30 1=1,2 
DO AO J = l,2 

XMNN(I, J)=XMNN(I, J) + XMQQP( I , J ) *A*MU 
40 CONTINUE 
30 CONTINUE 
RETURN 
END 

MATRIX MULTIPLICATION SUBROUTINE 

SUBROUTINE MATMUL ( A , B , M, L , N , C) 

REAL *8 A(M,L),B(L,N),C(M,N) 

DO 10 I = 1 , M 
DO 20 J = 1 , N 
Cd, J)=0.0 
DO 30 INDEX 5 1 > L 

C(I,J)=C(I,J) + Ad > INDEX) XB( INDEX, J ) 

30 CONTINUE 
20 CONTINUE 
10 CONTINUE 
RETURN 
- END 

MATRIX TRANSPOSE SUBROUTINE 

SUBROUTINE TRANS( A , B, M, L ) 

REALX8 A(M,L),B(L,M) 

DO 10 1=1, M 
DO 20 J=I , L 
B( J , I ) =A( I , J ) 

20 CONTINUE 
10 CONTINUE 
RETURN 
END 

MATRIX TRACE SUBROUTINE 

SUBROUTINE TRACE(A,M,TRAC) 

REALX8 ACM, M) 

TRAC=0 . 0 
DO 10 1=1, M 
TRAC=TRAC + A(I,I) 

10 CONTINUE 
RETURN 
END 

MATRIX ADDITION SUBROUTINE 

SUBROUTINE MATADDC A , B, M, L , C) 

REAL*8 A(M,L),B(M,L),C(M,L) 

DO 10 1=1, M 
DO 20 J=l, L 

C(I,J)=A(I,J) + B(I, J) 

20 CONTINUE 
10 CONTINUE 
RETURN 
END 
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SUBROUTINE BIGFORC B IGM , BIGF , MQQ , XMQN , FQ , XMNQ , XMHN , XKN , FN , U ) 

REALX8 BIGM(3,3) ,BIGF(3, 1) ,XMQN(1,2) ,XMNQ(2, 1) , XMNN( 2, 2) , XKN( 2, 2 ) 
REAL *8 FN(2, 1) ,U(2, 1) ,MQQ,P(2, 1) , FQ 
M=2 
L = 1 

BIGM( 1,1) =MQQ 
BIGM( 1 , 2) =XMQN( 1,1) 

BIGM(1,3)=XMQN(1,2) 

BIGM( 2, 1 ) =XMNQ( 1,1) 

BIGM( 2 , 2) =XMNN( 1,1) 

BIGM( 2 , 3 ) =XMNN( 1,2) 

BIGMC3, 1)=XMNQ(2, 1) 

BIGMC 3 , 2) =XMNN( 2, 1 ) 

BIGM( 3 , 3 ) =XMNN( 2, 2) 

BIGFC1, 1)=FQ 

CALL MATMUL(XKN,U,M,M,L,P) 

BIGFC2, 1)=FNC1,1)-PC1,1) 

BIGF(3,1)=FN(2,1)-P(2,1) 

RETURN 

END 



SUBROUTINE XL EQ ( BIGM, BIGF, SOL ) 

REALMS BIGM(3,3),BIGF(3,I),SOL(3), WKAREA( 18 ) 
M= 1 
N = 3 

CALL LEQT2F ( BIGM, M, N , N, BIGF, M, NKAREA, IER) 

DO 10 1=1,3 
SOL(I)=BIGF(I, 1) 

10 CONTINUE 
RETURN 
END 



SUBROUTINE GLOBCGPOS, W, DEFM) 
REALX8 GP0S(3),W(3,3),DEFM,RL(3) 
RL ( 1 ) = 1 . 0D0 
RL ( 2) =0 . 0D0 
RL(3)=DEFM 
N = 3 
L = 1 

CALL MATMUL ( W, RL , N , N, L , GPOS) 
RETURN 
END 

ENDJOB 

/X 

// 
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DERIVATION OF THE SHAPE FUNCTION MATRIX 
AND THE NODAL DISPLACEMENT VECTOR 

A cubic shape function is assumed to represent the 
transverse displacement of the single link flexible arm 
as follows, 

2 3 

v = x + x + a^ x - displacement (C.l) 

2 

I = a^ + 2. a 2 x + 3. a^ x - slope (C.2) 

The boundary conditions of zero displacement and slope 
at the base where x is equal to minus the link length, L, 
is invoked. This is in accordance with the positive sign 
convention of the local coordinate system. 

Substituting the boundary conditions into the shape 



functions gives, 

v(-L) = a Q - a 1 L + a 2 L 2 - a^ = 0 (C.3) 
<j>(-L) = a x - 2. a 2 L + 3. a 3 L 2 = 0 (C.4) 
v(0) = a Q ( C . 5 ) 
<M0) = a x (C. 6) 



Substituting (C.5) and (C.6) into (C.3) and (C.4) and 
solving the two equations for a2 and a3 gives: 

a 2 = (2. <j>(0) L - 3. v(0))/L 2 (C.7) 

a 3 = (4>(0) L - 2. v(0))/L 3 (C.8) 
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Substituting (C.5) , (C.6) , (C.7) , (C.8) into (C.l) and 



collecting terms gives an expression for the transverse 
displacement along the arm length as a function of the arm 
tip nodal displacements, v(0) and $(0), 



v(x) = 1. - (3. x 2 )/L 2 - (2. x 3 )/L 3 ) v(0) + (x + 
(2. x 2 )/L + (x 3 )/L 2 ) 4>(0) 



(C. 9) 



Substituting v(x) into the 3x1 deformation vector 
results in a 3x2 shape function matrix and a 2x1 nodal 
displacement vector as follows. 



r 



0 



0 



1 



D = (0,0, v(x) ) 



! (v(0),<j>(0)) T 



(1 - 



0 



3x‘ 



0 



o 3 , 2 3 

2x v , . 2x . x v 

— 3 ) (x + — + 77> 

Li Li 



(C. 10) 



Since the expression v' ' is necessary for determining 
the potential energy due to deformation, the shape function 
matrix is differentiated twice and results in the following 
modified shape function matrix. 



0 



0 



(0 , 0 , v ' ' ) T 



0 



( - 



12x, 

L 3 ' 
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0 






(v(o) ,<f>(o) ) 

(C.ll) 



The theoretical strain is computed from the expression 
for v'' obtained from the modified shape function matrix. 
Assuming simple beam theory, v'' is approximated to equal 
the curvature, and since curvature is related to strain, the 
following expression is obtained for the strain: 

e = c , v' ' (C. 12) 

ml 

£ is the strain at the maximum distance from the 
m 

neutral axis 

c^ is the maximum distance from the neutral axis 
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APPENDIX D 



LINEARIZATION, STATE SPACE REPRESENTATION, 
AND OPTIMAL CONTROLLER DESIGN 
OF SINGLE -LINK DYNAMIC EQUATIONS (ERLS; 



The equations of motion for the single-link flexible arm 
were defined as follows: 

MQQ 0 + MQN U = F (D.l) 

MNQ 0 + MNN U + KN U = FN (D.2) 

The linearized operating point is defined as follows: 

U = 0.0 0 = 0.0 (D . 3 ) 

U = 0.0 0 = 0.0 

U = 0.0 0 = 0.0 

Taking the differential of each coefficient and term in 
the equations of motion and evaluating them at the operating 
point gives the following two linearized equations of motion. 
F x 0 + F 2 U = T (D. 4) 

F 3 0 + F 4 U + F 5 U = 0.0 (D . 5) 



where the coefficients are the linearized complements of 
the non-linear coefficients as follows: 

F^ is from MQQ, is from MQN, and T is the applied 
torque . 



F^ is from MNQ, F^ is from MNN, and F^ is from KN . 
The state space variables are defined as follows: 



X 
t— ' 

II 


e 

• 


X 


x 3 


V 


X 


II 

ID 

X 


V 


X 



2 u 
x 4 = i 

6 = * 



(D . 6) 



85 



Utilizing equations (D.3) through (D.5) and the state 
variable description, the following 6x6 matrix equation 
is formed: 



0 


F 1 


F 2 


0 


" 

0 




*1 


0 


0 


0 


0 


0 


1 

°i 


X 1 


f 


V 






1x2 








• 














1 

) 


X 2 


1 
















x 2 




0 


0 


0 


0 


-F= 


1 




o 


' 0 


F 3 


F 4 


0 


0 


! 




— 


0 


0 


0 


0 


0 

2x2 


t 

1 


! 

x 0 


+ 


0 




2x1 


2x2 








• 
















1 J 




1 


0 


0 0 


0 


0 


1 


X 4 




0 


1 


0 


0 


0 


0 




x 4 




0 


0 


0 


0 0 


1 


0 




X 5 

• 




0 


0 


1 


0 


0 


0 




x 5 




0 


0 


0 


0 0 


0 


1 




X 6 




0 


0 


0 


1 


0 


0 




x 6 




0 


L 












- 














J 






L J 



M F T x 

(D . 7 ) 

Equation (D.7) is then put into standard state space 
format , 

X = A X + B u (D . 8 ) 

where A=M~^ F and B=M - ^ T^. 

The output equation having C as the identity matrix is, 

Y = C X 

Using the mainframe computer CONTROLS program OPTSYS, an 
optimal controller for the linearized equations of motion is 
designed and the optimal feedback gain control matrix, Gc , 
is determined. The closed loop feedback control system for 
the linearized plant is as follows: 
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